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© This invention relates to an above knee prothesis which employs a hydraulic damper to passively regulate 
the angular velocity or rotation of the artificial knee joint. A programmed microprocessor recognizes common 
gait patterns from information received from strain and knee angle sensors on the prosthesis. The microproces- 
sor reacts at various transition points in the gait by activating a motor which in turn adjusts a valve assembly in 
the damper. The valve assembly is capable of variably and separately damping the knee joint motion in each of 
flexion and extension at the same time. Gait is improved because of the improved extent of control of knee 
action. In addition, distinct routines such as stair descending and sitting down can also be practised. 
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FIELD OF THE INVENTION 

This invention provides a system for controlling the rotation of a knee joint of an above knee prosthesis. 
The system employs a microprocessor, responsive to lower leg strain and knee angle measurements 
5 originating from sensors on the prosthesis, to control a hydraulic damper through operation of a valve 
assembly associated with the damper, to thereby passively damp or resist the rotation of the artificial knee 
joint. 

BACKGROUND OF THE INVENTION 

w 

As previously stated, the present invention is used with an artificial leg or prosthesis worn by an above 
knee amputee. 

There are today about 50 different above knee prosthetic devices on the market. Many of these 
prostheses involve: 
is - a socket for receiving and engaging the stump of the user; 

- a knee bracket rigidly connected to the socket; 

- a frame extending down from the bracket and being pivotally connected to the bracket by a horizontal 
shaft, said bracket, shaft and frame together combining to form an artificial knee joint; 

- a pylon and artificial foot connected to the base of the frame; and 

20 - means for controlling the knee joint by locking it to prevent it from buckling under load in the stance 
phase of a step, and freeing it in the swing phase of the step. 
Now, the biological or natural knee joint is powered by the actions of muscles. Muscle has two 
elements. One is the active force developed by contraction and the other is variable stiffness. It has not 
been feasible to duplicate muscle contraction in leg prosthetics, due to limitations arising from weight and 

25 bulk. As a result, research has focused on implementing stiffness into the knee joint This has usually 
involved switching the knee joint between one of two modes: locked up or free to rotate. 

In recent years, researchers have sought improvement in controlling the action of the artificial knee 
joint, as a way to improve gait and enable the amputee to better deal with certain distinct actions, such as 
descending stairs or lowering into a sitting position. 

30 A relevant patent in this regard is French patent 2623-086-A. This patent teaches providing a strain 
gage sensor on the frame between the knee joint and foot, to measure load. The electronic signals from the 
sensor are transmitted to a microprocessor which monitors the load measurement When the load signal 
indicates that the swing phase of the step is ending and load is being applied to the leg, the microprocessor 
causes a motor or electromagnet to lock up the knee joint. When the stance phase is complete, the 

35 microprocessor instructs the actuator to release the knee joint, so that it is free to pivot in the swing phase. 

Another relevant prior art reference is Russian patent SU1 333-333-A. This patent teaches using a 
sensor at the knee hinge, to measure knee angle. Means lock or free the knee hinge in response to the 
knee angle measurements. 

Another relevant prior art device is known as the Henschke Mauch S-N-S system for controlling an 

40 above knee prosthesis. This system incorporates a linear hydraulic damper for resisting rotation of the knee 
joint at a single damping rate in the stance phase. The damping rate can be varied by manual adjustment 
When the knee joint is fully extended, the damper assumes a non-resisting mode. Otherwise stated, the 
system lacks automatic variation of damping and incorporates only two states, namely high resistance to 
flexion in stance phase and free rotation in swing phase. 

45 If a knee joint is looked at as a simple hinge, there are two separate actions which can occur. In 
"flexion", the knee joint rotates to enable the upper and lower leg segments to move closer together. In 
"extension" the knee joint rotates in the opposite direction, the leg segments move apart and the leg 
straightens. For an artificial knee joint to more closely simulate a biological knee joint, it is necessary that 
control or stiffness be applicable separately and variably in each of the flexion and extension modes. For 

so example, it is desirable at the beginning of the stance fi.e. weight bearing) phase of the step to allow a 
small amount of knee flexion to occur and to then lock the knee against further downward flexion while 
simultaneously freeing the knee to extend as the leg straightens due to body action. So in the latter phase 
of this action, the knee joint is altered to being locked or stiff in flexion and free in extension, at the same 
time. 

55 To applicant's knowledge, there is no artificial knee joint mechanism disclosed in the prior art which 
enables separate, simultaneous and automatic variable control of flexion and extension. 

If such a mechanism could be devised, then a much more sophisticated control over the knee joint 
action could be implemented. 
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it is the object of the present invention to supply such a mechanism and to then incorporate it in an 
improved overail prosthesis. 

SUMMARY OF THE INVENTION 

5 

The present invention relates to an on-board, computer-directed system adapted to provide improved 
automatic control of knee joint rotation in an above knee prosthesis (AKP) having upper and lower leg 
segments joined by the knee joint, said lower leg segment having a foot. In general, the system comprises: 

- a linear, hydraulic damper which can separately and variably damping or resisting each of flexion and 
70 extension rotational movements of the knee joint; 

- electronic sensing means for measuring each of AKP knee angle and lower leg strain (which are 
respectively indicative of the angle between the leg segments and the position of the center of gravity 
of the user's body relative to the AKP foot) and emitting signals indicative thereof; 

- actuating means, such as a servo motor, for adjusting the damping means to vary the resistance to 
75 rotation of the knee joint in at least one of flexion and extension; and 

- programmed computer means for receiving the emitted signals from the sensing means continuously 
establishing from said signals the state of the AKP in the course of a repetitive movement and 
activating the actuating means as required to vary damping to substantially simulate knee action. 
More particularly, the computer means is preferably adapted to do this by comparing the signals to 

20 stared threshold values which are indicative of pre-determined transition point between states of the 

AKP in the course of a movement, and, when the received signal values correlate with stored values, 
then causing the actuating means to vary damper resistance as required so that the AKP knee joint 
action substantially simulates natural knee action. 
It will be noted that the invention involves separate variation of damping of AKP knee joint action in 
25 each of flexion and extension. "Damping" for this specification means resisting rotational movement of the 
knee joint. The resistance may be substantially complete, in which case the knee joint is substantially 
prevented from rotating in one or both of flexion and extension. The resistance may be partial, in which 
case the rate of rotation of the knee joint is restricted in one or both of flexion and extension. Or the 
resistance may be non-existent, in which case the knee joint is free to rotate in one or both of flexion and 
30 extension. Alternatively stated, the damper is adapted to control the rate of rotation of the knee joint in one 
or both of flexion and extension. 

To enable such bi-directional damping, applicant has developed a novel damper incorporating a piston 
and means for controlling the piston. More particularly, the variable, linear, hydraulic damper comprises: 

- a hollow closed cylinder filled with hydraulic fluid and having a cylindrical hollow piston adapted to 
35 slide longitudinally within the cylinder chamber; 

- the piston preferably has axial rods extending from its ends, which rods project through sealed 
openings in the end walls of the cylinder. The piston further carries an exterior circumferential seal 
ring between its ends, for sealing against the side wall of the cylinder; 

- a first aperture and check valve assembly, associated with a first end wail of the piston, enables fluid 
40 to enter the piston chamber from the first end of the cylinder chamber; 

- a second aperture and check valve assembly, associated with the second end wall of the piston, 
allows fluid to enter the piston chamber from the second end of the cylinder chamber; 

- a first pair of diametrically opposed ports extend through the piston side wail adjacent its first end, on 
one side of the seal ring; 

45 - a second pair of diametrically opposed ports extend through the piston side wall adjacent its second 
end, on the other side of the seal ring; 

- preferably, each first port is offset circumferentially from the second port on that side of the piston; 

- preferably, each port is slit-like in configuration; 

- a valve preferably extends into the cylinder and piston chambers and is adapted to progressively 
so reduce or increase the effective area of the first (or flexion) ports available for fluid flow and separately 

progressively reduce or increase the area of the second (or extension) ports; 

- most preferably the valve comprises a rotatable shaft extending into the piston chamber in parallel 
relation to the cylinder axis, said shaft carrying a pair of radially protruding, diametrically opposed 
lobes, each lobe being adapted to substantially seal against the inside surface of the piston side wail, 

55 each lobe further being adapted, when the shaft is rotated, to progressively cover or uncover the 

adjacent flexion and extension ports, to thereby separately and simultaneously control flow area 
through the flexion and extension ports. 
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In use, one rod of the piston is connected to one segment of the AKP and the far end of the cylinder is 
connected to the other segment. For purposes of this description, it is assumed that the upper push rod of 
the damper piston is pivotally connected to the upper leg segment of the AKP and the lower end of the 
cylinder is pivotally connected to the lower leg segment. Therefore, in flexion the damper will contract and 
5 thus the piston will be driven downwardly in the cylinder by body load. In extension, the damper lengthens 
and the piston is pulled upwardly by body action. 

In the operation of the damper: 

- If the valve is positioned to enable flexion and if the piston is forced downwardly, thereby pressurizing 
fluid in the lower end of the cylinder chamber, fluid will flow upwardly through the lower check valve 

70 and extension ports, if open, into the piston chamber and will leave the piston chamber through the 

upper flexion ports - fluid will not leave the piston chamber through the extension ports (if uncovered) 
because there is no significant fluid pressure differential between the lower end of the cylinder 
chamber and the piston chamber; 

- If the valve is positioned to enable extension and if the piston is pulled upwardly, thereby pressurizing 
75 fluid in the upper end of the cylinder chamber, fluid will flow downwardly through the upper check 

valve and flexion ports, if open, into the piston chamber and will leave the piston chamber through the 
lower extension ports - again fluid will not leave the piston chamber through the flexion ports because 
there is no significant fluid pressure differential between the upper end of the cylinder chamber and 
the piston chamber. 

20 It will be noted that the damper design is characterized by the following attributes: 

- The valve can be adjusted to vary port areas and thus fluid flow rates to thereby vary resistance to 
knee joint rotation in either flexion or extension at the same time, thereby enabling variation of 
damping in both directions at the same time; 

- Because the ports are provided in diametrically opposed pairs, the valve does not get pressed against 
25 one side of the piston wall under heavy load and therefore does not seize up or become difficult to 

move - thus a small motor and shaft can be used to control the damper, which contributes to the 
compactness and lightness of the unit; 

- Because the damper is hydraulic, it is not significantly affected by wear and remains substantially 
consistent in its damping performance, thereby enabling the user to become accustomed to its 

30 "action" and to gain confidence in its performance. One could argue that the temperature of the 

hydraulic oil could vary and this would affect consistency of performance but this effect is minimized 
by using aircraft hydraulic fluid. 
In a broad aspect, the damper design therefore involves providing: 

- a pair of closed chambers (for example the two ends of the cylinder chamber; 

35 - means (for example the piston and cylinder) connected to the leg segments and forming two 
passageways (for example each formed by a check valve assembly, the piston chamber and a pair of 
the ports), for moving or pumping fluid from one end chamber to the other through one of the 
passageways when the leg segments are moving together and through the other of the passageways 
when the leg segments are moving apart; and 

aq - means (for example the valve and port assembly) for regulating the flow of fluid through each 
passageway. 

In another aspect of the invention, advantage is taken of the repetitive nature of leg actions. If, for 
example, one is walking along a level surface, there are patterns of knee angle and lower leg strain 
measurements which do not change significantly from step to step. By monitoring the two sets of signals 
45 and timing, the computer software can determine the stage or state of AKP motion and can initiate 
appropriate changes in flexion and extension capability. If there is deviation from the regular pattern, such 
as stubbing the AKP toe in the course of swing phase, the software can detect this change and initiate 
corrective action. 

Thus the system incorporates a method for controlling the knee joint of an AKP, which can be stated in 
50 the case of level walking as follows: 

- storing, in a computer memory, threshold values of lower leg strain and knee angle, which values are 
indicative of the knee bending in stance phase, of anterior positioning of the center of gravity of body 
weight relative to the ankle or foot, and of swing phase, all in the course of a step along a level 
surface; 

55 - continuously sensing lower leg strain and knee angle during use of the AKP and producing electronic 
signals corresponding thereto; 
• comparing the signals against the stored threshold values and, when the signals substantially correlate 
with threshold values, actuating means for altering the rate of rotation of the knee joint in at least one 
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of flexion and extension to enable the knee joint to flex at about the beginning of stance phase, to lock 
the knee joint against flexion while enabling extension in the middle portion of stance phase, and to 
free the knee joint as it approaches the swing phase, thereby substantially simulating natural knee 
action; and 

5 - repeating the foregoing repetitiously. 

By combining the sensing means, the damper having means which can simultaneously and separately 
control flexion and extension and the software based on the profiles of repetitive motion, a knee joint system 
has been evolved which is characterized by closely controlled, predictable responses. This results in the 
user gaining confidence in the system which then manifests itself in the form of a longer and more rhythmic 

to gait. The software can react similarly whether the gait is fast or slow. And the software can be "fine tuned " 
to the particular user to gain further compatibility or altered to modify the operation of the AKP. In addition, 
the system is adaptable to controlling the knee joint in the course of actions other than level walking, such 
as stair descent and sitting. 

From the foregoing, it will be understood that the invention utilizes programmed computer means for 

75 receiving the emitted signals from the sensing means, continuously establishing from said signals the state 
of the AKP in the course of a movement and activating the actuating means to vary damping to substantially 
simulate natural knee action. More particularly, the programmed computer means is adapted to compare 
the emitted signals against stored threshold values indicative of transition points between states of a 
repetitive movement of the AKP and, when the signals substantially correlate with threshold values, to alter 

20 the rate of rotation of the knee joint in one or both of flex-on and extension. Preferably, the stored threshold 
values are selected from the group consisting of the absolute and derivative values of knee angle and the 
position of the center of gravity of the user's body relative to the AKP foot, the duration from the last 
transition point and the possible future states in the course of the movement. 

The invention described can be thought of as a machine which reacts to the amputee's movements, 

25 thus improving gait. Confidence in the machine is necessary for the amputee to take full advantage of the 
machine's capabilities. This confidence is developed by ensuring that the machine reactions are reproduc- 
ible, step after step. 

In order to obtain consistent and reproducible reactions, the invention takes advantage of the reproduc- 
ible mechanics of the prosthesis during normal walking. As previously stated, during each step the knee 
30 goes through a pattern of movement which is basically the same, step after step. Also reproducible from 
step to step are the strains on the frame of the AKP, developed by the weight of the amputee, and the 
angle changes of the knee joint. 

The repetitive nature of the signals is an important aspect of the success of the invention. This allows 
the prosthesis to have consistent man/machine interactions. The prosthesis is a tool used by the amputee to 
35 perform different tasks. If the performance of this tool is predictable and reproducible, then user confidence 
is gained. 

With the reactions occurring at the same time and in the same manner for each step, the amputee 
develops trust in the machine and is able to walk with a continuous fluid motion. 

In summary, the invention works on the principle that each step can be divided into segments or states 
40 and that a machine reaction can be developed for each segment, thus improving gait. The division of the 
step is carried out by first obtaining information from the prosthesis, conditioning this information with 
electronics and analyzing it with software, and then implementing machine reaction by separately and 
simultaneously varying resistance to flexion and extension rotation of the knee joint. 

45 DESCRIPTION OF THE DRAWINGS 

Figure 1 is a block diagram showing the flow of information in the system; 

Figure 2 is a perspective simplified view of the Hall effect sensor used for providing signals indicative of 
knee angle; 

so Figure 3 is a plot of knee angle sensor output versus knee joint rotation; 

Figure 4 is a perspective view of the prosthesis in exploded form; 

Figure 4A is a perspective view of the prosthesis in assembled form; 

Figure 5 is a plot of strain sensor output versus strain or load on the prosthesis; 

Figure 6 is a diagram showing the states in level walking, with the appropriate state conditions shown; 
55 Figure 6a is a diagram showing the states in level walking and correlating them with, leg action, piston 

position and valve position; 

Figure 7 is a plot showing the relationship between knee angle and strain (ankle bending moment or 
load) signals, related to the states, for level walking; 
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Figure 7a is a diagram showing the states in stair descent and correlating them with leg action, piston 
position and valve position; 

Figure 8 is a diagram showing the states in sitting down, with the appropriate state conditions shown; 
Figure 8a is a diagram showing the states in sitting down and correlating them with leg action, piston 
5 position and valve position; 

Figure 9 is a plot showing the relationship between knee angle and strain signals, related to the states, 
for sitting down; 

Figure 10 is a diagram showing the states in stair descent, with the appropriate state conditions shown; 
Figure 11 is a plot showing the relationship between knee angle and strain signals, related to the states, 
70 for stair descent; 

Figure 12 is a comprehensive diagram showing the states and conditions for the various modes of 
action; 

Figure 12a is a comprehensive diagram corresponding with Figure 12 and showing the various body 
actions; 

75 Figures 13 and 14 are simplified sectional side views showing the piston and cylinder in flexion and 
extension modes; 

Figure 15 is a simplified end view of the internals of the piston; 
Figures 16-24 are views similar to Figure 15, showing the valve in various positions; 
Figure 25 is a side sectional view of the cylinder and piston; 
20 Figure 26 is an overall circuit diagram of the system; 
Figure 27 is a diagram of the communication circuit; 
Figure 28 is a diagram of the microprocessor chip; 

Figure 29 is a diagram of the voltage references and regulator for the analog to digital converter located 
on the microprocessor chip; 
25 Figure 30 is a diagram of the conditioning electronics for the Hall effect sensor; 
Figure 31 is a diagram of the conditioning electronics for the strain sensor; 
Figure 32 is a diagram of the conditioning electronics for low battery detection; 

Figure 33 is a flow chart of the software and Figure 34 is an interrupt service routine which is activated 
every 20 milliseconds; and 
30 Figure 35 is a perspective view showing strain gauge positioning on the base of the frame. 

DESCRIPTION OF THE PREFERRED EMBODIMENT 

Having reference to Figures 4a and 4b, the prosthesis A comprises a suction socket 1 which is custom 
35 fabricated to closely fit the stump of the amputee and to cling to it by suction. An adjusting plate 2 is 
attached to the base of the socket 1 . A knee bracket 3 is secured by screws to the adjusting plate 2. The 
knee bracket 3 has apertured shaft supports 3a, 3b for receiving, supporting and affixing the main knee joint 
shaft 9 and the damper shaft 15 respectively. A frame 4, having a bearing 4a at its upper end, is rotatively 
mounted to the knee bracket 3 by the main shaft 9, which extends through the bearing 4a. The frame 4 is 
40 therefore free to rotate or pivot on the fixed main shaft 9. At its lower end, the frame 4 forms a rectangular 
socket member 4b for receiving a rectangular block 7a which is clamped to the upper end of the foot pylon 
7. Screws secure the pylon block 7a to the frame socket member 4b. A foot 8 is secured to the lower end 
of the pylon 7. 

An upper bearing housing 12 is mounted for rotation on the damper shaft 15. The damper shaft 15 is 
45 located to the rear of the main knee joint shaft 9, so that the shaft 15 and upper bearing housing 12 follow 
an arc relative to the shaft 9 when the knee bracket 3 rotates or pivots. 

A Hall effect sensor 13, shown in Figure 2, is provided to monitor the change in knee angle or knee joint 
rotation. The sensor 13 used is available from Sprague Electronics and is designated as model UGN-3503U. 
This sensor 13 comprises a ring magnet 11, which is fixed to the stationary damper shaft 15 of the knee 
so bracket 3 by a ring magnet keeper 10. The sensor 13 further comprises a Hall effect transducer 13a, which 
is located in the rotatable upper bearing housing 12 and which is positioned facing the ring magnet 11. As 
knee joint rotation occurs, the bearing housing 12 moves around the damper shaft 15, causing the 
transducer 13a to move relative to the ring magnet 11. 

The transducer 13a has a voltage output which is dependent on the magnet flux intensity (north or 
55 south pole) directly before it. Therefore, as the knee joint rotates, the output of transducer 13a changes. The 
signal from the linear Hall effect transducer is amplified to produce .5 volt with a knee joint extended fully 
and 4.5 volts with the knee joint flexed fully. Included in the circuit is a gain adjustment and an offset 
control. Stated otherwise, the signal of the transducer 13a is lowest when the knee is straight and increases 
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as the knee is bent. Figure 3 shows a typical sensor voltage output with respect to knee angle after 
amplification. 

The forces on the foot 8 are established by measuring the strain of the frame 4. This is done using foil 
strain gauges 6 available from Micro Measurements Group Inc., Raleigh, North Carolina under designation 

5 CEA - 06 - 062 UW-350. Four gauges 6 are used, two at the front and two at the rear of the frame 4, 
located between the frame apertures 101 and the base of the frame 4, to measure and differentiate between 
load on the heel and load on the toe of the foot 8. Stated otherwise, the strain measurement provides an 
indication as to whether the user body center of gravity is in the anterior, centred or posterior position 
relative to the AKP foot. The four gauges are wired in a wheatstone bridge configuration to produce an 

w electric signal which changes proportionally with strain. The wheatstone bridge configuration is a standard 
arrangement for determining the resistance change of strain gauges. The output of the bridge is amplified 
by a differential instrumentation amplifier 1 26 to produce an output signal of .5 volts when the heel is loaded 
fully and 4.5 volts when the toe is loaded fully. No load or similar load on the toe and heel produces 2.5 
volts. Included in the circuit is gain adjustment and an offset adjustment. Figure 6 shows a typical voltage 

75 output of the bridge with respect to foot loading after the signal is amplified. It will be noted that the load 
signal decreases as the heel is loaded and increases as the toe is loaded. 

A servo motor bracket 14 is secured to the base of the bearing housing 12. A servo motor 16 is 
mounted within the bracket 14. The motor used is available from Airtronics Ltd. under designation 94737. 
An upper spring retainer 17 is mounted on the base of the servo motor bracket 14, for a purpose to be 

20 described. 

A damper B is positioned between the servo motor bracket 14 and the base of the frame 4. 

The damper B comprises a hollow cylinder 26, which is externally threaded. A lower spring mount ring 
27 is threaded onto the outside surface of the cylinder 26, for a purpose explained below. A lower bearing 
mount ring 29 is also adjustably threaded onto the outside surface of the cylinder 26, at its lower end. The 
25 ring 29 has radially extending threaded bores 100, normal to its central axis, which fit lower bearing pins 5 
which are threaded through apertures 101 in the base of the frame 4. Thus the base of the cylinder 26 is 
pivotally coupled to the base of the frame 4 by threading the pins 5 into the bores 100 of the ring 29. A lock 
ring 28, threaded onto the external surface of the cylinder 26, is tightened against the ring 29 to lock it in 
place. 

30 A lower cap 30 fits into the bore 102 of the cylinder 26 at its lower end and closes the bore. The lower 
cap 30 is held in place by a snap ring 103. The lower cap 30 carries a circumferential O-ring 104. for 
sealing against the side wall 105 of the cylinder 26. An aperture 106 is formed through the cap 30. An O- 
ring 107 is mounted in this aperture 106, sealing around the dummy push rod 25 of a piston 24. 

At its upper end, the cylinder 26 has an upper cap 21 which fits into the cylinder bore 102 and is held 

35 in place by a snap ring 108. The upper cap 21 also carries a circumferential O-ring 109, for sealing against 
the side wall 105 of the cylinder 26. An aperture 110 is formed through the cap 21. An O-ring 111 is 
mounted in this aperture 110, for sealing around the push rod 22 of the piston 24. 

The hollow cylindrical piston 24 is positioned in the cylinder bore 102. The piston 24 comprises an 
open-ended drum 112 having upper and lower end caps 113, 114 screwed thereinto. A push rod 22 extends 

40 upwardly from the upper end cap 113, through the sealed aperture 110 in the cylinder cap 21, and is 
secured to the servo motor housing 14. From the foregoing, it will be noted that the bearing housing 12, 
servo motor housing 1 4 and push rod 22 form a train of components connected to the damper shaft 1 5 and 
bracket plate 3. Thus as the socket 1 pivots about the main shaft 9, this rotational movement is converted 
into linear movement of the push rod 22 and piston 24. 

45 A tubular spring 18 extends concentrically around the cylinder 26 between the upper spring retainer 17 
and lower spring mount ring 27, for assisting the assembly to increase rate of knee extension during the 
swing phase of gait. This is useful in enabling increased speed of gait. 

The piston 24 and cylinder 26 are shown in simplified form in Figures 13 and 14, with the fluid flows 
identified by arrows in each of flexion and extension. 

so The cylinder 26 is a closed or sealed unit and it is filled with hydraulic fluid. The piston 24 carries an 
external circumferential ring seal 115 for sealing against the side wall 105 of the cylinder 26. 

The upper cap 113 of the piston 24 has an aperture 116 opening into the piston chamber 117. A spring- 
loaded one way check valve 118 controls the aperture 116 and allows pressurized hydraulic fluid to move 
downwardly from the upper end of the cylinder chamber 119 into the piston chamber 117. 

55 The lower cap 114 of the piston 24 has an aperture 120 opening into the piston chamber 117. A spring- 
loaded one way check valve 121 controls the aperture 120 and allows pressurized fluid to move upwardly 
from the lower end of the cylinder chamber 119 into the piston chamber 117. 
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The check valves used are available from the Lee Company, Westbrook, Connecticut, under designa- 
tion CKFA 2506205A. 

A first pair of diametrically opposed flexion ports 122 extend through the piston side wall 123 at a point 
above the piston circumferential seal 115. A second pair of diametrically opposed extension ports 124 

5 extend through the piston side wall 123 at a point below the circumferential seal 115. 

From the foregoing and having reference to Figure 13, when body weight acts downwardly on the push 
rod 22 and piston 24, with the flexion ports 122 open, hydraulic fluid may flow upwardly from the lower end 
of the cylinder chamber 119, through the lower check valve 121 into the piston chamber 117, out of the 
piston chamber through the flexion ports 122 and into the upper end of the cylinder chamber 119. 

10 Therefore, as long as the flexion ports 122 are open, the piston 24 may move downwardly, the damper B 
may contract and flexion of the knee joint may occur. If the flexion ports 122 are only partly open, there is 
damping or resistance to the knee rotation in flexion. If the flexion ports 122 are closed, the piston 24 is 
prevented from moving downwardly and the knee joint is locked against flexion. 

Similarly, having reference to Figure 14, when the push rod 22 and piston 24 are pulled upwardly, with 

75 the extension ports 124 open, pressurized hydraulic fluid may flow downwardly from the upper end of the 
cylinder chamber 119, through the upper check valve. 118 into the piston chamber 117, out of the piston 
chamber through the extension ports 124 and into the lower end of the cylinder chamber 119. Therefore, as 
long as the extension ports 124 are open, the piston 24 may move upwardly, the damper B may extend and 
extension of the knee joint may occur. If the extension ports 124 are only partly open, there is damping or 

20 resistance to knee extension. If the ports 124 are closed, the piston 24 is prevented from moving upwardly 
and the knee joint is substantially locked against extension. 

As previously stated, restriction of the fluid flow through the ports reduces the flow of fluid through the 
hollow piston, thereby controlling the rate of movement of the piston. 

The rate of flow of the fluid is controlled by an adjustable rotatable valve 23. This valve 23 is illustrated 

25 in Figures 4, 4b and 16 - 24. It comprises a shaft or rod 36 carrying a pair of lobes 125. The rod 36 extends 
axially and centrally into the piston chamber 1 17. It further extends upwardly through a bore 126 in the push 
rod 22 and is drivably connected wjth the servo motor 16 housed in the bracket 14. 

The lobes 125 extend radially from the rod 36, substantially seal against the inside surface of the piston 
side wall 123 and each is adapted to extend vertically across both the upper flexion port 122 and the lower 

30 extension port 1 24 on one side of the piston 24. 

The associated ports 122, 124 on each side of the piston 24 are circumferentially offset, as shown in 
Figures 16-24. Stated otherwise, the lower extension port 124 begins approximately where the upper 
flexion port 122 ends. The ports 122, 124 are narrow elongate horizontal slits. Typically they might have a 
length of .25 inches and width of .02 inches. 

35 Therefore, there is a progressive nature to the reduction and subsequent increase in open area of a port 
as the valve lobe moves across it on a rotational travel. This of course affects the rate of fluid flow through 
the piston chamber 117 and determines the relative damping or resistance to rotation experienced by the 
knee joint. 

By circumferentially offsetting the associated pair of upper and lower ports, there is a sequential and 
40 separate nature to the opening and closing of flexion and extension ports. 

Stated otherwise, and as shown in Figures 16-24, the flexion and extension ports of an associated pair 
of ports on one side of the piston: 

- can each be separately progressively opened or closed; or 

- each can be separately fully opened or closed; or 

45 - one can be fully closed while the other is progressively closed; or 

- both can be fully closed, 

and all of the foregoing can be accomplished with a single motor and valve, thereby assisting in achieving 
compactness and low weight. 

The rotation of the inner valve 23 is determined by the software controlling a microprocessor 32, which 

50 in turn controls the servo motor 16. 

Each step or movement of the prosthesis has been divided into segments (states), dependent on 
comparison of the incoming sensor signals and preset threshold values. Held in the memory of the 
microprocessor is a position signal for the inner valve 23. With each change from state to state the inner 
valve 23 position is altered, thus achieving a different knee joint control. For example, referring to Figure 6A, 

55 state No. 1, the initial portion of stance phase, the inner valve 23 is set to allow fluid to escape from the 
flexion ports 122 and consequently the knee joint can bend as the amputee applies weight. The 
programmed computer monitors the increasing knee angle and when it reaches the stored threshold value 
that indicates that the knee has bent to the predetermined angle initiating state No. 2, then the position of 
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the inner valve 23 is altered to completely restrict fluid flow from the flexion ports 122 and allow flow from 
the extension ports 124. This stops further knee joint bending and allows extension. 

The above example illustrates that the assemply can have different control parameters depending on 
the direction of knee joint rotation (i.e. locked in flexion and allow extension). The fluid passes through 
5 separate ports for each of the two directions of knee movement. Therefore, if the flexion and extension ports 
are restricted independently of each other, the control of the rate of piston movement can be different for 
each direction. 

The Figures 16-24 show discrete positions for the inner valve 23. In fact the positioning of the inner 
valve can be set at any position from 0 to 100 degrees, thus obtaining virtually an infinite range of knee joint 
70 damping. This is desirable for "tuning" the leg in activities such as stair descending, where the rate of 
descent must appeal to the amputee. 

The microprocessor 32 used is available from Motorola Semiconductors Ltd. under designation XC 68 
HC 811 E2 FN. This is an 8 bit processor having 2K of memory, 8 analog to digital converters, and 8 digital 
inputs. The chip is about 1" x 1" and there is no need for any other peripheral chips, thereby allowing it to 
75 fit into a small package within the prosthesis A. 

The knee angle and load sensor signals are amplified and then fed directly into the microprocessor 32. 
The amplifiers 126, 127 used for knee angle and load signal conditioning are available from Texas 
Instruments under designations TLC 272 and TLC 274 respectively. 

As shown, the amplifiers 126, 127 and microprocessor 32 are mounted on a circuit board 20 and are 
20 enclosed together with a battery 34 (Motorola SNN 4038A) and battery holder 33 in a shell 19 which is 
secured to the frame 4. 

SOFTWARE 

25 The software is set forth in the flow chart and attached Appendix. 

Due to the similarities of the sensor information during the course of each step from one step to another 
(repetitiveness) it is possible to determine the amplitude of each of the two signals at transition points 
during each step. These transition points are important times when the damping of the knee joint should be 
altered to allow the amputee to walk. The transition points are detected by the processor 32 by comparing 

30 the predetermined "threshold" values, stored in memory, with the real signals from the prosthesis A and 
cycling through the transition points as they occur. As long as the amputee continues to produce signals as 
expected, the processor can keep track of the cycle. 

With this type of software in operation the hydraulic damper B can be adjusted as each transition point 
occurs, to a new position which was predetermined during fitting. 

35 This system can therefore determine the position of the prosthesis A during the course of each step 
and apply an appropriate damping coefficient to the knee joint. Furthermore it is possible to detect whether 
the amputee is walking on level ground, down stairs, sitting down or has encountered a dangerous situation 
such as the toe of the prosthesis hitting the ground during swing phase (toe stubbing). 

40 Level Ground 

Figure 6A illustrates the point. Each of the numbered circles are referred to as states. The processor 
always begins in state #1 where the step begins. As the amputee applies weight to the prosthesis A the 
knee joint begins to bend. This increases the knee angle signal which is continuously being compared to a 
45 preset threshold value and as it equals or exceeds the threshold value the processor cycles to state #2. The 
hydraulic damper setting is altered at the transition point to predetermined settings to allow knee flexion 
while in state #1 and to lock knee flexion while in state #2. 

During state #1 the damper's function is to damp knee flexion and simultaneously allow knee extension 
and during state #2 to lock knee flexion and simultaneously allow but damp knee extension. Note that the 
so flexion damping has gone from a damped setting to a locked setting independent of the damped knee 
extension setting. This design allows the amputee to straighten the knee during state #2 even though the 
knee flexion is still locked. 

The damped setting is required to control the rate of knee extension as the amputee proceeds. If a free 
extension setting was chosen the knee would "snap" straight giving the amputee a noticeably abnormal 
55 gait. 

The initial knee flexion after heel contact and the straightening of the knee is found in normal gait 
patterns and is referred to as "knee bounce". 
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The exact mechanics as to how the hydraulic damper functions is shown in Figure 6A beside each 
numbered circle. 

Figures 6 and 7 show the rules used for the comparison and the actual values of the output of the 
sensors expected for one step. Following through the step it can be seen that the transition from state #1 to 
5 state #2 occurs as the knee angle signal in Figure 7 increases. 

The graph shows that knee flexion stops shortly after the transition to state #2. The time delay is the 
time required for the damper to change. 

As the amputee proceeds through the step the next important event is swing phase (time while the foot 
8 is off the ground). Indication of the oncoming swing phase can be detected by continuously monitoring 
70 the load signal and comparing it to a predetermined value. 

As the centre of gravity of the amputee pass over the foot, weight is applied to the toe. The increase in 
the load signal causes the processor to switch to state #3 as soon as the load signal is equal to or exceeds 
the predetermined threshold value. The damper is commanded to unlock the knee joint, thus allowing the 
amputee to initiate swing phase when ready. 
75 The entire swing phase is tracked by the processor. The transition to state #4 occurs when the knee 
signal increases past a preset threshold value as the knee joint flexes during the initial portion of swing 
phase. 

After state #4 the strain or load signal is ignored and the processor monitors the first derivative of knee 
angle. The derivative is an indication of the speed and direction of the knee rotation. As the knee joint 
20 reaches the maximum flexion during swing the derivative becomes zero and detection of this produces a 
switch to state #5. Note that the same command for the damper is maintained throughout states #3-4-5, that 
is, free flexion and free extension which allows swing phase to be completed. 

Completion of the swing phase is detected when the knee angle signal decreases past a preset 
threshold value to indicate that the knee joint has extended back to the straight position. The processor 
25 switches to state #1 and the entire process is repeated as long as the amputee continues to walk on level 
ground. 

Emergency Swing Phase Recovery (Stubbing the Toe) 

30 The normal repetitive pattern of knee angle and strain information causes the processor to cycle 
through state #'s 1-2-3-4-5-1 (see Figures 6 & 7). When the toe of the prosthesis has contacted an obstacle 
during the swing phase the pattern is different. The pattern is now 1-2-3-4-5-6-1. After state #5 the 
processor monitors the knee angle derivative information and switches to state #6 if the first derivative has 
become positive, indicating that the knee is no longer extending but is now flexing (i.e. the obstacle has 

35 interrupted the normal velocity of the knee extension). During state #6 the damper is instructed to lock the 
flexion of the knee joint. 

Additional state changes exist for the level walking diagram. Circumduction is the completion of the 
swing phase without flexing the knee joint. This is done by swinging the limb sideways in an arc to clear the 
ground instead of flexing the knee. Without the flexion of the knee during the swing phase the processor 
40 would switch from state #'s 1-2-3 and stop. This problem is alleviated by measuring the time that the 
processor is in state #3 and if the knee has not been flexed in a predetermined amount of time the 
processor switches back to state #1 regardless of any inputs. 

Sit Down Mode 

45 

During the daily events there are times when the amputee is sitting for an extended period of time. The 
knee joint of the prosthesis should be in an unlocked position for this time in order for the amputee to 
position the leg in any desired position. For instance he may wish to have it flexed to place the foot under a 
chair, or in a right angle position to sit upright or in a partially flexed position for sitting in a car. The 
so positioning is done by manipulating the prosthesis usually with the hands or the contralateral (other) foot. 

Sitting is accomplished by training the amputee to perform a certain move to instruct the processor of 
the attempt to sit down. Figures 8A and 8 show the cycle of states for sitting down. Figure 9 shows the 
change in signals for a typical sit down motion. Initially the processor will be residing in state #1. The 
amputee leans backward which increases the load on the heel of the prosthesis and begins to flex the knee 
55 joint. The processor switches from state #1 to state #2 as the knee signaJ passes a preset threshold value 
(see state change on Figure 9). 

The load on the heel decreases the load signal past a preset threshold value and the processor 
switches to state #7. As soon as the processor switches to state #7, a timer starts and measures the time 
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which the load is present on the heel. After 1/3 of a second the processor switches to state #8 which 
commands the damper to allow knee joint flexion. The amputee bears weight on the prosthesis and 
descends to the chair at a controlled rate. Measurement of time is again made and the processor switches 
to state #9 after 3/4 seconds. This commands the damper to be free in both flexion and extension of the 
5 knee joint, allowing the amputee to manipulate the leg to be comfortable in the seated position. The 
processor will remain in state #9 until the knee joint is extended to the straight position thus decreasing the 
knee angle signal past a threshold value at which the processor switches to state #1 . 

Stair Descending 
10 — 

The usual method for an amputee to descend stairs is to use only his good leg to lower his body weight 
down each stair until his prosthesis contacts the next stair. He then repeats the motion again using the good 
leg. The prosthesis is not used at all and the descent is "one stair at a time". 

The second method is for the more agile amputee and consists of the norma! "step over step" 
75 approach but doing so with the knee having uncontrolled descent as his weight flexes the knee (jack 
knifing). 

The present invention incorporates a method of first detecting the fact that the amputee is about to 
descend a step and then offering a controlled rate of descent. 

In order to initiate the descending of stairs, the processor must receive the appropriate signals from the 
20 user. This is done by placing the heel of the prosthesis on the edge of the stair and applying weight. Similar 
to level walking the first state change is from state #1 to state #2 as the knee begins to flex (see above).. At 
this point the load signal decreases (heel loading) and the processor switches to state #7 and then to state 
#10 as the load reaches a preset threshold value (see Figures 10 & 1 1). 

Note that the amount of weight placed on the heel by the user determines whether the processor stops 
25 at state #7 (detects "sit-down") or continues to state #10 (detects "stairs"). The user is trained to apply the 
appropriate weight to instruct the processor correctly. 

A timer is started when the processor switches to state #10. As long as the user maintains the load for 
1/2 second the processor will then switch to state #11. During state #11 the damper is commanded to damp 
the flexion of the knee joint and allow extension. This damping is similar to the hydraulic control unit on a 
30 door. The rate at which the door can swing is controlled by the hydraulic fluid within the cylinder. For the 
knee this damping is preset dependent on the wishes of the user. Some like to descend stairs at a slow rate 
while others prefer a fast descent. 

At completion of each stair the user descends the next step on his contralateral (other) limb. During this 
time the processor is waiting for the knee joint to extend during the swing phase. The extension reduces the 
35 knee signal past a preset threshold value and the processor switches to state #12. The damper is 
commanded to lock flexion and allow extension. The user again places the heel on the next stair and 
repeats the sequence 7-10-11-12 for each step. Note that the processor does not return to state #1 after 
each step. This is due to the lack of a complete extension of the leg prior to the next step. 

Once the flight of stairs has been completed, the knee joint is extended to the straight position and the 
40 processor switches to state #1 as the knee angle is reduced to a preset threshold value. The choice 
between stairs, sit down or level walking is now available. 

Figure 12 shows all of the states grouped together. At the beginning of each step the software detects 
whether the amputee is proceeding on level ground (state #'s 1-2-3-4-5-1), has stubbed the toe during a 
step on level ground (1-2-3-4-5-6-1), is sitting down (1-2-7-8-9-1) or is descending stairs (1-2-7-10-11-12). 
45 The amputee need not push any buttons or turn any levers to instruct the processor to change functions 
for different terrains. Detection is automatically done in real time dependent on the movements of the 
amputee. 

Additional features of the state diagram include a battery life saver. If the amputee stops for more than 
3 seconds in states 1 , 2 or 9 the processor stops powering the control motor and goes to a shutdown state, 
so A low battery warning beeper signals the user that battery replacement is required. In the event that the 
battery is completely depleted the damper is commanded to damp flexion and free extension prior to 
complete loss of power. This allows the amputee to still bear weight on the leg without excessive knee 
flexion until a charged battery is placed in leg. As the flexion is damped the swing phase must be 
accomplished by circumduction during this time. 

55 
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40 
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42 
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,-AUCAPS: main entry point or CONSTANTS 
;lower: local labels 
; Mixed Ram variables 
;name. subr 

;NAME[ main commands dispatched 



text formats 



15 
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25 
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70 



75 



20 



25 



30 



35 



AO 



45 



46 
47 

4a 

49 
50 
51 
52 



60 
61 
62 
63 
64 
65 
66 
67 
68 
69 
70 
71 
72 
73 
74 
75 
76 
77 



0000 
00FF 
1000 



0001 
(Oil 

[Oil 
F800 
F900 



78 
79 
80 
81 
82 

83 F800 

84 (00| 
85 

86 
87 

88 0000 
89 
90 
91 
92 
93 
94 
95 
96 
97 
98 
99 
100 
101 



(Oil 

(001 

1000 
1002 
1003 
1004 
1005 
1007 
1008 



generally a blank lino follows change* in flow, or logical thought, 
or bafora entry pointa. 



;Externai addreaaea in currant knee controller 5/88 
;Using EVM board defaults to simplify debugging 
;MC8 has RAM 0-7W. ROM 8000-ftff. DACs fffO-ffff 



53 


RAM 


90000 - 


SOOFF 


256 bytes or 51 2 in E9 chip 


54 


REGS 


$1000 - 


$10FF 


$8000 in MC8 IF needed 


55 


EEPROM 


$8600 - 


SB7FF 


512bytee 


56 


EPROM 


$F0O0 - 


$FFFF 


4k 2732 external 


57 


EPROM 


50000 - 


9FFFF 


12k in 68HC711E9 


58 


EEPROM 


9F800- 


$FFFF 


2k in -A2/E2 cpus 


59 


OACS 


SFFFO - 


SFFFF 


only 8 active, eddr wrap*. 



RS 

TOS 

REG 



equ $0000 ;Rem starts hare 

equ RS + $FF ;Top Of Stack for -A1 (256 bytes) 

aqu $1000 ; Registers sit here 



,9/02/90. to use EVM for development 

; can't load EVM EEPROM @ $B600 directly with S records so we're stuck here 
CHIPA2 equ 1 ;if using -A2/E2 for code 





ifndef CHIPA2 


;if not -A2/E2 


EE 


aqu $B600 


; EEPROM starts here in - A1/E9 version 


EES 


equ IF 300 


;Rules stored here for 1 st time up. 


;Bootup copies to EE if difference in 1st 2 bytae detected (date). 


ROM 


aqu $F900 


; 2732 stsrts @ $0F000. 2764 Q $0EOOO -A2 <SP F800 




else 


;in a 2k EEPROM device we have... 


EE 


aqu $F800 


;£EPROM starts here in -A2 version in Single Chip mode 


ROM 


aqu SF900 


;start code hare in single chip mode 


;EE 


aqu $E800 


; EEPROM aat here in -A2 version in Expanded mode. 


;ROM 


equ $E900 


; start code here in Expanded mode 


EES 


equ EE 


.both in some place in -A2'a 




endif 






cpu dsf ns. Lisas REG value defined above or daf suits to $1000 IFNDEF 




INCLUDE d:\o681 1 \rule\a»m\681 1 reg.aem 




INCLUDE \A681 1\681 1 REG.ASM 




.NUST 0 




;01/28/91 






ifndef REG 


.default if not defined elsewhere 


REG 


equ $1000 






endif 




6811 CPU I/O PORTS 


PORTA 


equ REG + $00 


;Port A & Timer Funcs 


PIOC 


equ REG + $02 


.-port dir/stbs control 


PORTC 


equ REG *■ $03 


tfon C I/O 


PORTB 


aqu REG * $04 


;Port B Out 


PORTCL equ REG + 505 


:Port C Latched in 


DORC 


equ REG ♦ $07 


;Data OtR port C 


PORTO 


equ REG + $08 


.Port 0 



50 



55 



13 



4SOOCIO <EP 0S4Q855A2_I_> 



EP 0 549 855 A2 



w 



is 



20 



25 



30 



35 



40 



45 



102 
103 
104 
ICS 
106 
107 
108 
109 

no 
in 
112 

113 
114 

us 

116 
117 
118 
119 
120 
121 
122 
123 
124 
125 
126 
127 
128 
129 
130 
131 
132 
133 
134 
135 
136 
137 
138 
139 
140 
141 
142 
143 
144 
145 
146 
147 
148 
149 
150 
151 
152 
153 
154 
155 
156 
157 
158 



1009 
100 A 



1008 
100C 
1000 
100E 
1010 
1012 
1014 
1016 
1018 
101A 
101C 
101E 
1020 
1021 
1022 
1023 
1024 
1025 
1026 
1027 



1028 
1029 
102A 



102B 
102C 
102D 
102E 
102F 



1030 
1031 
1032 
1033 
1034 



103S 
1039 
103 A 
103B 
103C 
1030 
103F 



oooo 

0002 
0003 



DORD equ REG + $09 
PORTE equ REG + $0A 



; • • • • TIMER 
CFORC equ 
0C1M 
0C10 



equ 
equ 
equ 
equ 



TCNT 
TIC1 
TIC 2 
T1C3 
T0C1 
T0C2 
T0C3 
T0C4 
TOCS 
TCTL1 
TCTL2 
TMSK1 equ 
TFLG 1 equ 
TMSK2 equ 
TFLG 2 
PACTl 
PACNT 



•qu 



equ 
equ 



equ 



/ COMPARE 
REG + $08 
REG + $OC 
REG + $00 
REG + $06 
REG + $10 
REG + $12 
REG + $14 
REG + $16 
REG + $18 
REG + $1 A 
REG+$1C 
REG + $1E 
REG + $20 
REG + $21 
REG + $22 
REG + $23 
REG + $24 
REG +$25 
REG + $26 
REG + $27 



SP! PORT 
SPCR equ REG + $ 28 
SPSR equ REG + $29 
SPOR equ REG + $ 2A 



;Oata 0»R port 0 

.•Port £ for digital in on A/0 

REGS 

.'Compere force reg 

;0C1 acoon Mask 

;0C1 Oata 

Jimer Counter reg 

.input Capture 1 

;IC2 

;IC3 

; Output Compere 1 

;0C2 

;0C3 

;0C4 

;0C5 

; Timer Control Reg 1 
;TC reg 2 

; Timer MeSK interrupt reg 1 
.-Timer FLaG int reg 1 
.-Timer MeSK int reg 2 
.Timer FLeG int reg 2 
;Pulee Acc ConTroL reg 
;PA CouNT 



;SP1 control reg 
;SP1 status 
;SPI data 



; • • • • SERIAL COMMUNICATION INTERFACE REGS 



BAUD 

SCCR1 

SCCR2 

SCSR 

SCDR 



equ REG +$2B 
equ REG + $2C 
equ REG +$20 
equ REG + $2E 
equ REG + $2F 



A/0 REGS •••• 
ADCTU equ REG + $30 
equ REG + $31 
equ REG + $32 
equ REG - 



A0R1 
A0R2 
A0R3 
A0R4 



;boud rata register 

;SCt control register 1 

;SCI register 2 

;6Ct statue register 

.serial commumcotione data register 



;A to 0 control register 
;A/0 reeuite 



► $33 
equ REG + $34 



; • • • • CPU CONTROL REGISTERS 



BPROT equ REG + $35 

OPTION equ REG + $39 

COPftST equ REG + $3A 

PPROG equ REG + $38 

HPRIO equREG + $3C 

INIT equ REG + $30 

CONFIG equ REG + $3F 



; Block protect in -E8 flavour 
.'system configuration optione 
.-COP arm/reeet 
;EEPROM Control 

.highest priority 1-bit interrupt and misc. 
.-Rem 4 I/O mapping 

:Cop/Rom/EEprom eneblee & EE adr in -A2 



: • • • offsets for indirects 
_PORTA equ $00 ;Pon A & Timer Funca 
_P!OC equ $02 ;port dir/ettos control 
J»ORTC equ $03 .Port C I/O 
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70 



75 



20 



25 



30 



35 



40 



45 



159 

160 

161 

162 

163 

164 

165 

166 

167 

168 

169 

170 

171 

172 

173 

174 

175 

176 

177 

178 

179 

180 

181 

182 

183 

184 

185 

186 

187 

188 

189 

190 

191 

192 

193 

194 

195 

196 

197 

198 

199 

200 

201 

202 

203 

204 

205 

206 

207 

208 

209 

210 

211 

212 

213 

214 

215 



0004 
0OO5 
0007 
0008 
0009 
000 A 



0O0B 
OOOC 
OOOD 
000 E 
0010 
0012 
0014 
0016 
0018 
001 A 
001C 
001 E 
0020 
0021 
0022 
0O23 
0024 
0025 
0026 
0027 



0023 
0029 
002A 



002B 
002C 
0020 
002E 
00 2F 



0030 
0031 
0032 
0033 
0034 



0035 
0039 
0O3A 
0038 
003C 
0030 
003F 



_PORTB equ $04 ;Port B Out 

_PORTCL equ $05 ;Port C Latched in 

_DDRC aqu $07 ;Oete OiR port C 

_PORTD aqu $08 ;Port 0 

_DORD aqu $09 ;Oata OiR port 0 

_PORTE aqu $0A ;Port E for digital in on A/0 



TJC1 
>IC2 
~T1C3 



TIMER 
_CFORC aqu 
_0C 1 M aqu 
0C1D aqu 
>CNT aqu 
aqu 
aqu 
aqu 
JT0C1 aqu 
JT0C2 aqu 
_T0C3 aqu 
_T0C4 aqu 
~T0C5 aqu 
JTCTL1 aqu 
_TCTL2 aqu 
~TMSK1 aqu 
_TFLG1 aqu 
JTMSK2 aqu 
JTLG2 aqu 
PACTL equ 
>ACNT oqu 



/ COMPARE REGS 
$08 ;Comparo forca rag 
0C1 action Mask 
0C1 Data 
;T1mar Counter rag 
;lnput Capture 1 
;IC2 
$14 ;IC3 

$16 ;Output Compare 1 
0C2 
0C3 
$1C ;0C4 
$1E ;0C5 

;T!mer Control Reg 1 
;TC rag 2 

; Timer MaSK interrupt rag 1 
;Timer FLaG int rag 1 
$24 ; Timer MaSK int rag 2 
$ 25 ; Timer FLaG int rag 2 
;Putse Acc ConTroL rag 
;PA CouNT 



$0C 
$00 
$0E 
$10 
$12 



$18 
$1A 



$20 
$21 
$22 
$23 



$26 
$27 



..... spf p0RT 

_SPCR equ $28 ;SP1 control reg 
_SPSR equ $29 ;SPI status 
_SPDR equ $2A ;SP1 data 

SERIAL COMMUNICATION INTERFACE REGS 
JJAUO aqu $2B ;baud rata register 
_SCCR1 aqu $2C :SCI control register 1 
_SCCR2 equ $20 ,-SCl register 2 
_SCSR equ $2E ;SCI status register 
_SCDR equ $2F ;sahaJ communications data register 

..... Af0 RgGS 

M ADCTU equ $30 ;A to 0 control register 
_ADR1 aqu $31 ;A/0 results 
_A0R2 equ $32 
_ADR3 equ $33 
ZaOR4 equ $34 

CPU CONTROL REGISTERS 
_BPROT equ $35 ;B)ock protect in -E8 flavour 
^OPTION equ $39 ; system configu ration options 

_COPRST equ $3A ;COP arm/reset 

_PPROG equ $3B ;EEPROM Control 

JHPRIO equ $3C .'highest priority 1-bit interrupt and misc. 
JNIT equ $30 ;Ram & I/O mapping 

_CONRG equ $3F ;Cop/Rom/EEprom enaWes & EE adr in -A2 
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20 
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21 6 




• • •Soma standard constants 


21 7 


0000 


NUL 




'Null tarminntion for itrinn* 


218 


0001 


EOT 


4CfU $01 


*Fnd of Taxi 


219 


000 A 


LF 


•qu $0A 


;LF 


220 


0000 


CR 


aqu $00 


;CR 


221 


001 1 


XON 


equ $ 1 1 


;*Q 


222 


0013 


XOFF 


aqu $13 


;*S 


223 


001 A 


EOF 


equ $1A 


■*7 

t 4* 




001 B 


ESC 


equ $18 




443 


0018 


CAN 


equ $18 




44B 


QQ2Q 


SPC 


equ $20 




227 










440 






.UST 










ENO 


jo* oennitions 


4JU 










111 
I 










4il4 










4JJ 


(Will 


S ORATE aqu $4 


.ueoug step ra?e 


2 J* 










*J5 


|A1 I 

10 II 




ifdef MH27 


,li /.J/iBMnZ ... 






; • • • • Servo specific valuas 




4J / 




8RATE 


equ $12 


» # 1 * ■ 9 OVA/ err OVAJ SJ» / ,J / 40Mrt2 


4<>a 




RTCRAT 


equ 36864 


,reet time ciock ■ 4umd4C rof /.j/ZoMnz xtaf 


4J# 




MDEG 


equ 22 


,*Appfox sceio tic to time for 7.3728 




toi 1 

\\i 1 1 




else 




241 


0030 


BRATE 


equ $30 


.'define default com rata $30« 9600B $34-5008 


242 


9C40 


RTCRAT 


equ 40000 


;reaJ time clock 20mSac 


243 


0014 


MDEG 


equ 20 


;Approx scaia tic to time 


244 


(001 




endif 




245 










246 




Tarminal t/O Codaa 




247 


00 2A 


PROMPT 


aqu '•' 


.prompt char 


246 


003E 


GRS 


aqu '>' 




249 


003C 


LTS 


aqu '<' 




250 


0030 


EOS 


aqu 




251 


0000 


EOL 


aqu CR 


;cr on input 



252 
253 
254 
255 
256 
257 
258 
259 
260 
261 
262 
263 
264 
265 
266 

267 
268 
269 
270 

271 0000 



EEROM use in single chip mode -A2 
;0000 0O0F Oate, Bdrete... CHNTBL 

;0010 01FF Rula teblee (up to coda lower limit), currently 00 FF 



; RAM un 

,-00 - OF Copy of EE being adjusted. Must Save to make changes permanent 
;10 - IE Srcedr. Curmbf. Currul, Scnrul, Outadr, Frcrul. Frctim, 
;20 - EMPTY 

;3E Beeper timer (don't move, dup dafn in rules for separata assembly), 

;40 - 4F Main Rage & ram variables 

;50 - 6F Analog RFO 24 bytes + denvetives (8) 

;70 - 7F Timer OCx reloads & phaaaa (yet to implement) 

;80 • BF I/O buffers It vera ;1NBUF_STA used by pbee for EESAVE ram routine 
;C0 - FF stack space (EO* mini) "Each int uses 9 bytes of stack!! 



Ride work space * • * • • 
org RS ; workspace for tuning/adjust 
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272 


0010 


RS1Z 


equ 16 


;th»9 many to store in EE at a time 




273 


0000 


Wrxrui 


da RSIZ 


;spaca for copy of whatever wa'ra adjusting 




274 












275 










0 


276 


0010 




org RS + 


$10 .start of ram tabias 




277 


0010 


Srcadr 


ds 2 


;sourca addross of rula * (or data) in ram 




278 


0012 


curmbf 


equ d 


.fix assembler stupidity (00 NOT MOVE Curmbf. BRULxx fixed raf 




279 


) 

0012 


Curmbf 


da 4 


; where active mode bit fields stored (32 MAX rule* for now) 




280 


0016 


stime 


oqu $ 


; stupid assembler 


70 


281 


0016 


Stime 


OS 2 


shutdown timer (battery) DO NOT MOVE Stime. BRULxx fixed raf) 




282 


0018 


Curmod 


OS 1 


.-currently active mode. Currul MUST follow 




283 


0019 


Curnjl 


DS 1 


; currently active rule. 




284 


001 A 


Outedr 


OS 2 


;addraaa of motor value for fired rula (grime) 




285 










75 


286 


001 C 


Frcrul 


da 1 


.Forced rule, MUST precoed Frctim 


287 


0010 


Frctim 


ds 1 


;Rulo timer. MUST follow Frcrul. (SEARCH) & inits STD X 




288 












289 


0016 


Inhrul 


da 1 


;Rula to inhibit for time specified. Inhtim MUST FOLLOW 




290 


001 F 


Inhtim 


ds 1 


.•Inhibit a rula timer. Inhrul MUST PRECEED 




291 


0020 


Scnrul 


OS 1 


.-scan rul counter (SEARCH) MUST follow Inhtim 


20 


292 










293 


0021 


Ocltimo OS 2 


;0C1 period. Basic sample rate (not yet used) 




294 












295 


0023 


Rtime 


OS 2 


; Beeper timer register 




296 












297 


0025 


Off edr 


OS 2 


;addresa offset for print outs 




298 










25 


299 




;Rag 


da 2 < 


;REG address for fewer bytes of LDX #REG (9 refs) not used yet 




300 












301 






Main vars 


in RAM 




302 


0030 




org RS + 93D 




303 


1008 


BPORT 


aqu PORTO ;b««per port 


30 


304 


0020 


BBJT 


equ $20 ;bit in PORTO controlling beepar (DS » *SS) 




305 


0030 


Btima 


da 2 


;beeper command bytes (chg + cmd) Ctime MUST follow 




306 


003F 


Ctime 


da 1 


;count of beeps MUST Follow Btima 




307 












308 


0040 


Ragl 


da 1 


:Bit flags & constants. Rag2 - 4 MUST FOLLOW in RAM 




309 


0080 


XFRFLG 


oqu $80 


- Xoff received 


35 


310 


0040 


EFLG 


aqu $40 


.input echo on 




311 




;LFLG 


oqu $20 


;Hne feeds 




312 




;HFLG 


aqu $10 


;hex input ;not used since commented out in Hex-b 



40 



45 



313 
314 

315 
316 
317 

318 0041 
319 

320 
321 
322 



x-bin 



0080 



;NFlG aqu $02 
;DBRG aqu $01 



Rag2 da 1 
;RRFIG equ $80 



HLTRG equ $80 



.'negative on input ;not used, commented out in ha 
.'debug print outs 



;Sit fiag & constants. MUST follow Flag 111 

;Rute in RAM being used, OONT OVERWRITE unless dear! 

;not needed since TIMINT ISR scans up to fired rule 

.'before returning. 

;h«Jt the rules (ban test) 
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323 


0040 


FRFLG 


equ $40 


;just firod • ruU. shortens scan so glitches & loops 


324 








.visible and allows FORCER a quick exit whan dona 


325 








;besica!fy one rule fires par TIM! NT. 


326 


0020 


MFLG 


equ $20 


;iock mode changes (must use FLAGS keyboard commanc 


327 


0010 


FFLG 


equ $10 


.we're Forcing a rule flag (forcer) 


328 










329 


0008 


CFUS 


equ $08 


;Change of rule 9, bkgnd prints new f if SET & clrs bi 


330 


t 

0004 


PFUG 


squ $04 


;Path found flag (scan) 


331 


0002 


SFLG 


•qu $02 


.'Scanning rules (timinc) flag, prevents recursive ints 


332 


0001 


TFLG 


•qu $01 


;Tune flag. No stale changes permitted if SET 


333 










334 










335 


0042 


Rag3 


ds 1 


;£it fields for rules to use. MUST PR EC E ED Reg4 


336 


0043 


Rag4 


ds 1 


.Spare flags, cleared et power up MUST FOLLOW Rag3 


337 










338 


0044 


Msbb 


OS 1 


.-Most significant byte of keyboerd input vetoes 


339 


0045 


Labb 


OS 1 


;Lsb • " \ MUST FOLLOW Msbb 


340 










341 


0046 


Lent 


OS 1 


;iine count. MUST precede Uth 


342 


0047 


Uth 


OS 1 


;ltne length for MEMOMP, MUST foHow Lent 


343 


0048 


Acnt 


OS 1 


; where print header function starts counting 


344 










345 


0049 


Dtemp 


OS 2 


.-Derive scratch space (addd). use stack?? 


346 










347 


0043 


Adjadr 


OS 2 


.-address of memory being adjusted (AOJ sets. TUNE uses) 


348 










349 


0040 


Tmot 


OS 1 


temporary motor output value during tuning 


350 










351 


0050 




org RS + $50 


352 


0010 


0S1Z 


equ 16 


.-index to start of newest data 


353 


0050 


Rfo 


ds OSIZ 


;Peet 2 blocks A/0 data. Lowest -oldest AO. Highest - newest A 7 


354 


0060 


Anldat 


ds 16 


.'Current analog data & denvetivee saved here 


355 








;© could save bytes if derivatives only on 4 channels 


356 










357 




.-setup in 


advance 


of changes to T1MINT to handle 4 trains simultaneously 


358 


0070 




orgRS + $70 


359 




Mtime 




.-Motor lime. Seme ee OC2 


360 


0070 


Oc2time OS 2 


;0C2 PW current motor timer value (LD_MOT0R & TIMINT) 


361 


0072 


Oc3timt OS 2 


;0C3 PW 


362 


0074 


0c4time 


OS 2 


;0C4 PW 


363 


0O76 


OcSttme OS 2 


;OCS PW 


364 


0078 


0C2ticp 


OS 2 


;0C2 tick/phase 


365 


007A 


0C3ticp 


OS 2 


;0C3 tick/phase 


366 


007C 


0C4ticp 


OS 2 


;0C4 tick/phase 


367 


007E 


OCSticp 


OS 2 


;OCS tick/phase 


368 










369 


0080 


RAMEND: 


equ $ ;viaibte merker 


370 






.page 





45 



50 



55 



18 



JSOOCIO: <EP_05488S5A2 J_> 



EP 0 549 855 A2 



10 



15 



20 



30 



371 




3 * i 




373 








4/3 




376 


0080 


377 


LHJdU 


378 




379 




380 


0080 


381 




332 


00 9 F 


383 


001 F 


384 


0000 


385 




386 


OOAO 


387 




388 


00 AO 


389 


00 A 2 


390 




391 


00A4 


392 


00AS 


393 




394 


00 A 6 


395 


OOAS 


396 




397 


00 A A 


398 


0016 


399 




400 




401 


OOAA 


402 


00 BP 


403 


0011 


404 


0000 


405 




406 





• • • I/O Buffer definitions 
;(a>@<a this can be reduced to byre pointers & indexing since ram < 256. 
; redesign En-quo/da-quo to ba dynamic sized and placed! NO INBEDED CONSTANTS I 

; But first we get ihe sucker to work. 



org RS ♦ $80 
BUFFS equ $ 
OUTSIZ aqu $20 



;l/0 Vars start hare 

.Buffers start here 

; Output size. 32 bytee or so 



OUT BF5TA 

;out bfsta 
out bfend 
out'bfmax 

out_bfmin 

IOSTR aqu 9 

Out_hdptr 
Out_tlpir 05 2 

Outjjffil OS 1 

lnj>ffil OS 1 

Jn_hdptr OS 2 
In'tlptr OS 2 



da OUTSIZ ;C start of buffer eddreee 

aqu BUFFS ;C start of buffer address 

aqu 0UT_BFSTA * OUTSIZ- 1 ;C and of buffer address 

equ 0UT~BFEND-OUT_BFSTA ;C almost full circular buffer 



aqu $00 



:C almost empty C8 



;Vars started here 



OS 2 .Out buffer haad pointer 

;Out tail pointer. Points one behind valid data 

;Out buffer fill (lnj>ffil MUST follow. STO in SCIINI) 

;ln buffer fill (MUST follow Outjjffil) 

;ln buffer heed pointer 
;ln buffer tail pointer 



IOEND equ i .ended here 

INSIZ equ $20-UOEND-IOSTR) .Input size -block size • vars used size 
;ie. we steel bytea from input buffer since almost always empty. 



IN BUFSTA 

IN^BFENO 

IN_BFMAX 

IN 8FM1N 



equ s 

equ IN BUFSTA - INSIZ- 1 
equ IN*BFEN0-IN_BUFSTA"4 

equ $00 



;C start of buffer address 
;C end of buffer address 
;C almost full Grcuier Buffer 

;C almost empty CB 
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407 
408 
409 

410 00AA 
41 1 
412 
413 
414 
415 
416 
417 
413 
419 
420 
421 
422 
423 
424 

425 
426 
427 
428 
429 
430 
431 
432 
433 
434 
435 
436 
437 
438 
439 
440 
441 
442 
443 
444 
445 
446 
447 



450 
451 
4S2 
453 
454 
455 
456 
457 
458 
459 
460 
461 
462 



101 1 



START OF EPROM 

relative ;Oack to normal to keep brenches happy 

;subr to updata EE from rom if dates differ 

tfndef CHIPA2 ;if not 2k EE 
org 1E000 :here for now 



EHUOATE: 



> 600 baud 



Idd #EE 
std Srcadr 
idd EES 
cpd EE 
beq rptofot 

Idaa 9 BRATE 

staa BAUO 
clr S4O00 

cii 

bar RUOATE 
bar raa2nd 

set 

rta 



;destinaoon eddreee for full update 
;atert» hare 
;new ROM dete 
;with current Dete 

.not different (DATES) so no need to change all 

;*F803 :FROM ROM let time.S30 -E/13/1 >9600 $34-E/13/16 

;tlx it 

;dr EVB aci ffio flop to enable com Tx 
; allow im'e so data cen gat out 

;do 256 

;next 256 

;stop ints until timer /mode inits dona 



;•• subroutine called to update EE with EPROM rulea 
RUOATE: Idx fuvmsg ;inform 

jar PMSG ;user 

Idx Srcadr .-current sourca in ram (EE write adr) 

;; baq rpbret ;nothmg to save, AN ERROR 

cpx f EE ;whare EE sits 

bio rpbrat ;not EE. skip itl 

Idy 9 EES ;rom table 
rea2nd: drb ;2S6 

rpcomp: Idea) O.y ;get current ram data 



;dbg.. 



empa 0.x 
baq rbdec 

pehb 
pern/ 

pen* 

jar H0UTC2 



psha 

jar HOUTS 
pula 



; compare with previous saved EE 
;same so skip pgming thia byta 

;save counter 

;seve currant pointer 

;seve data 

;dbg 

;ger back 
.save again 
;dbg 

.get data back 
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463 
464 
465 
466 
467 
468 
469 
470 
471 
472 
473 
474 
475 
476 
477 
478 
479 
460 
481 
482 
463 
484 
485 
486 
487 
488 
489 
490 
491 
492 
493 
494 
495 
496 
497 
498 
499 
500 
501 
502 
503 
504 
505 
506 
507 
508 



,\..dbg 



Idab #$16 
bsr rpbe 

cmpa #$FF 
beq Jrffdon 

Idab #52 ;program 
bar rpbe ;now 



;byto erase first 
;do it 

;did wo ONLY NEED an ERASE7 
;yaa. skip pgmg 



?rffdon: 



puiy 
puib 



rbdec: inx 
iny 



decb 

boa rpcomp 



rpbrot: rts 



;racovar am 



;bump pointers ahead 

;and cognt down 
;until zero 

;done update 



I02I 

102] 
[01 J 



; • • • * coda compression subr 
rpbe: ifdef COPON 

jsr copset .reset cop 

else 



Idy #2200 



;2500 * 10 msec® 4cy/dey 3333 * 1 0msec <S>3/d ex + 3/bns 



100 1 



;8 set to erase or pgm cmd, Y with delay value, and X pointing to address, 

;A with value to pgm 

;rpboe: 

stab PPROG ;set EELAT 

staa 0,x ; write or erase @ x 
ino PPROG ;EEPGM up 

?wt10: day countdown 
bna ?wt10 ;until done 

clr PPROG ;finished 
rts jreturn to EE coda 

uvmsg: db "Updating E*,*E* + $80 

and of ERUDATE 
endif 
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509 F800 org EES ; Rules start here 
510 

511 F800 RUtSTRT equ EE ; working EE is here 

51 2 ; INCLUOE D:\A681 1\RULE\ASM\BRUL29.ASM ;set of rules 

51 3 INCLUDE ASMNBRUL29A.ASM ;new eel of rules 

514 F800 INCLUDE ASM\BRUL30.ASM ; Kelly's name 
51 5 ; 14:40 11/12/91 

5 1 6 ; Base Rules BRUL30.ASM 

517 : example of RULE30 definition based on 01/15/91 baseml updated to 4/30/91 

51 8 ; 24 rules possible in this configuration, 3 modes supported, ail dynamic 

519 ; Revison History 

520 ; 1/28/91 added battery rule, HOR's 

521 ; 2/4/91 MB1AS, BORATE & SO RATE added in alterable EE 

522 ; 2/1 9/91 Pxed error in Mode table RULE8 has no cond OONT SCAN m 

523 ; 2/22/91 Increased size to 24 address & added spare byte to existing rules 

524 ; 2/28/91 Added demo digital rules 

525 ; 3/12/91 Adjusted rule values to new defaults 
52s ; 3/37/91 Add structure for Rags in rules 

S 27 ; 4/04/91 Reverse order of forced rules & timer to add Inhibit rulee 

52 a ; 4/9-1 2/91 Work on battery rules & refinements 

529 ; 4/30/91 KBJ Remove unused rules 

530 ; 5/0349/91 Rework battery rules 

531 ; 5/22/91 Add NCOL for debug width 

532 ; 11/12/91 Changed some values for four Tony Semps lag 

533 ; 11/14/91 rules for separata sit and stairs 
534 

535 public DATE.NUMRUL.NUMMO0,BFCNT f MBIAS,MO0E00,BORATE.CH 

530 public SUBAOR 

5 3 7 ;9vorything vise ehould be computable from tables as offsets 
538 

539 ; • • • Configuration defines 

540 (oi | ifndef RULSTRT .if not defined, must be separate assembly 

541 ; RULSTRT EQU $BC00 ;likely eddress if seperete eeeembry 

54 2 RULSTRT EQU $F800 .likely eddress if separata load 

543 BRATE EQU $30 ;usu«J baud rata 9600 

544 ; BRATE EQU $32 ;usuai baud rata 2400 

545 Btime equ $30 ;sitt here for now 
545 ;EE equ $B600 ;usuai if stand alone 
547 EE equ $F800 ,-usual if stand alone 
543 EES equ RULSTRT defaults saved hero 
549 extern Sbme.Curmbf ,*fix errors 

curmbf equ $12 :force a fix for DUMB assembler 
stime equ $ 1 6 X orce a fix for DUMB assembler 



550 
551 
552 

553 (001 endif 

554 0000 0 equ RUL5TRT-EE ;diffarsnce for absolute references 

555 

555 ; REVERSE equ 1 .define if channel order reversed 

557 Xey juot use CHNLST to change em. 

558 

559 0080 RN EQU $80 : Add to final rule $ in possible routes list 

560 

551 ; We need some definitions to aid later specification of Digital rules 

562 0080 DIG EQU $80 ;Bit high in first byte of rule if digital bits present in rul 

e 

563 0080 B7 EQU $80 ;MSB 

564 004O B6 EQU $40 
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565 
566 
567 
568 
569 
570 
571 
572 
573 
574 

575 

576 

577 

S78 

579 

580 

581 

582 

583 

584 

585 

580 

587 

588 

589 

590 

591 

592 

593 

594 

595 

596 

597 

598 

599 

600 

601 

602 

603 

604 

605 

606 

607 

608 

609 

610 

811 

612 

613 

614 

615 

616 

617 

618 

619 

820 



0O20 
0010 

oooa 

0004 
0002 
0001 



B5 EQU 420 
B4 EQU $10 
83 EQU $08 
B2 EQU $04 
81 EQU $02 
BO EQU $01 ;LSB 
;Oigital rule form is: 

;DBBB8BBB ;D-1. B-Bits that mattar -1.0- don't car*. 
XVVVVVVV ;Logic state (Value) for selected bits to meet condition, 
these two bytes present only if digital conditions are used. Dig bit (0> hig 

; in first byte of rule. 



0000 
0040 
0020 
OOIO 
OOOO 

0030 
0008 
007F 



[011 

0000 
OOOI 
0O02 
0003 
0004 
0005 
0008 
0O07 
0000 
0001 
0003 

101] 



ANL 
CHN 
GTV 
LTV 
EQV 

NEV 
DVT 
NONE 



CHO 

CHI 

CH2 

CH3 

CH4 

CHS 

CH6 

CH7 

KO 

LO 

BATT 



EQU $00 ;ANaLog. Dig bit low 

EQU $40 ;CHaiN bit high for additional analog conditions 
EQU $20 ;Greetor Than Value 
EQU $10 ;Less Than Vaiue 

EQU $00 ;EQa) Value (don't use generally. GT or LT safer since exact 

.match not reliable on eneJog inputs. 
EQU $30 ;Not Equal Value 
£QU $08 ;DeriVaTrve (time 20 Msec) 

EQU $7F ;Spedal case. ANL * CHN + NEV ♦ 0 VT + CH7 is DON'T CARE state 
;!ll No value follows a NONE condition. Ill 

1FNDEF REVERSE ;lf not reversed 



CHO 
CH1 
CH2 
CH3 
CH4 
CHS 
CHS 
CH7 

KO 
LO 
TO 
T1 
BATT 



EQUO 
EQU 1 
EQU 2 
EQU 3 
EQU 4 
EQU 5 
EQU 6 
EQU 7 

EQUO 

EQU 1 
EQU 3 

ELSE 

EQU 7 
EQUO 
EQU 5 
EQU 4 
EQU 3 
EQU 2 
EQU 1 
EQUO 



;Ane!og input channel numbers 
;makes redefinition eesier 



;Knee 
;Load 
;battery 

;rev«rsed 

;Analog input channel numbers 
;makee redefinition easier 



aqu 7 ;Knee 

equ 8 ;Loed 

equ 6 ;Temperature Knee? 

equ 5 .Temperature Load Cell? 



100) 



equ 4 

sndif 

.page 



;battery voltage 

end conditional 
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621 






622 






623 






624 






625 






626 






627 






628 






629 






630 


F800 




631 


FflOO 


11 14 91 


632 






633 


F803 


30 


634 


F804 


30 


63 S 


F805 


40 


636 


F806 


OF 


837 


F807 


31 


638 






fi?a 






640 






641 






642 






643 






644 






645 


F808 


1 \ 


646 






647 


F809 


17 


648 






649 






650 






651 


F80A 


03 


652 






653 






654 


F80B 


03 


655 






656 






657 


F80C 


02 


658 






859 






660 


F800 




661 






662 






663 






664 






665 


F810 




666 






667 






668 






669 






670 






671 


F810 


71 


672 


F811 


EO 


673 


F812 


00 


674 






675 







; Start of Rule table in EEPROM 

; Rules stay in EEPROM unless modified. 

; RULflAM bit field determine if a ram copy of a rule ia uaed since ram 
; is very scarce in single chip mode. 

; Modified rules are saved to EE when e different rule ie selected 

; for modification. 



; START OF DATA 

ORG RULSTRT 

DATE: OB 41 1,$14,$91 ;in HEX II 

BORATE: DB BR ATE ;Boud rate saved here to permit changee 

MBIAS: OB $30 ;Motor bias stored here. This ia current 11/14/91 value 

MSAFE: OB $40 ;Safe motor value used by BATTERY to lockup cylinder 

8RUU OB $0F ;Battary shutdown rule to fire after timeout 

BPVAL: OB $31 .Beeper value for battery 

:NUMber of RULee in table. This determine how high the search proceedee, 
;AND how many bytes are set eside for RULEADR's and RULTlM's. 
;spece for RULADR's is exact -2 # NUMRUL 

;space for RULT1M ie modulo 8. ie. 1-8-18.9-16-2B.17-24-38 etc. 
;Ditto MOOEOO, etc. 

NO MRU L: DB $11 ;!est rule 9 scanned. 24 rules max in this conffg. 

;Limit of scan. 
MAXRUL: DB 23 ; Maximum legal rule 9 0*23 

;NUMber of MO Dee. This makes a dynamic upload without relink possible. 
;since all addreeaee can be computed as offsets from RULSTRT. (but aren't yet) 



NUMMOO: DB $03 .-currently 3 supported. Limited by EE space & rule size. 
;7 max. 

BFCNT: DB $03 ;# bytes in bitfields since we could have more bit fields then 

;NUMRUL would indicete. Applies to MODEs. RULTlMs. RAMRUL 
NCOU db $2 ;0 columns to print during debug 

;CHsNnel LiST allows dynamic redefinition of input channels without having 
rto mess with ruiee. Allows us to fiddle between systems eestiy 

CHNLST: 

DB $10,$32.$54,$76 forward sequence 
DB $67,$45,$23,$01 ;reverae 



ORG RULSTRT* $10 



;Kaep positon stable if addition bytee edded 
; above (0 free) 



;RUlee with TIMe constraints. Bit field here saves space & speed 
.Binary field with MSB of lowest byte - RULEOO. LSB - RULE07. etc. 

RULT1M: 08 %01 110001 ;00-07 ;0 1.0 2.03. 07 have timer 
OB %1 1100000 ,-08-Of t -08,09.0A have timer 
DB%00000000 ;10-17 

;RULee with FLeGe as conditions. 
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676 


F81 3 


00 


677 


F81 4 


00 


678 


F81 5 


00 


679 


F816 




680 






681 






682 






683 


F81 6 


7r 


684 


F81 7 




68 S 


F81 8 


UU 


686 






687 






688 


F81 9 


oo 


689 


F81 A 


00 


690 


F81B 


00 


691 






692 






693 


F81C 


00 


694 


F810 


00 


695 


F81E 


oo 


696 






697 






698 






899 






700 






701 






702 






703 






704 






70S 


F81 F 




706 


F81 F 


p83 1 


707 


F821 


eacc 
rasa 


708 


F823 


roar 


709 


ca ie 
rBZ5 


raoo 


7lO 


r927 


ro / * 


71 1 

/I 1 


CQ 70 
ro« 


Pfl7A 

ro / v 


717 


PO*D 


F97C 


/ 1 J 


CP7H 


F880 


71 A 






71 K 




F888 


71 A 


PA"* 1 


F880 


717 


FS33 


F892 


71 A 

/ t o 


pane 


F898 


719 


FB37 


F89B 


720 


F839 


F89F 


721 


F83B 


F8A4 


722 


F830 


F8A4 


723 






724 


F83F 


F8A4 


725 


F841 


F8A7 


726 


F843 


F8AF 


727 


F845 


F887 


728 


FB47 


F8BF 


729 


P849 


F8C7 


730 


F848 


F8CF 


731 


F840 


F8D7 


732 







RUUFLG: 08 %00000000 .00-07 
08 %00000000 :08-Of 
DB%00000000 ;10-17 



; have flag words 



;Bit field of ective rules for a given mode. Seme OEF'N as RULTIM 

:For 24 rules. 3 bytes required. 

MODEOO: ;$F0 .NORMAL OPERATION 

OB %01 111111 ;00-07 ;0 1.02.03,04, 05,06.07 active conditions 
OB %00101 100 ;08-0f .-OA.OC.OO activo conditions 
0B%O0O0OO0O .10-17 

MODE01: ;*F1 

OB %00000000 ;00-07 

OB %00000000 ,*08-0f 

OB %00000000 MO-17 

MO0E02: ;5F2 

OB %00000000 ,-00-07 

OB %00O00O0O ,-08-Of 

OB%00000000 ;10-17 

;@ or use Reg bits to inhibit/enable rules OE & OF. 

; and so on for additional modes 

;NOTE!l A rule's STATE number is determined by its POSITION in THIS table, 
l-NOT its name (eg RULOA). This makes chosing alternate rules easy, just 
;put the alternates' address in the substituted position in table. 



RULADR: 



DW RULE0O*0:00-07 
OW RU LEO 1-0 
DW RULE02-0 
DW RULE03-0 
DW RULE04-0 
OW RULEOSO 
DW RULE06-0 
DW RULE07-0 

OW RULE08-0;08-OF 
OW RULE09-0 
DW RULEOA-0 
DW RULEOB-0 
DW RULEOC-0 
DW RULEOD-0 
OW RULEOE-0 
DW RULEOF-0 

DW RULE10-0;10-17ETC 

DW RULE1 1-0 

DW RULE 12-0 

OW RULE13-0 

DW RULE14-0 

OW RULE 15-0 

OW RULE16-0 

OW RULE17-0 
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733 






;Ust of subroutine addresses. Accessed by output values $F8-$FF. 


734 


F34P 




SUSAOfl: 




735 


F84F 


F80F 


DW SUBOO-O 


736 






DWSU801.0 


;etc 


/ J / 






;users responsibility w NOT call non-existent subroutines! 


7 TO 
/JO 










733 






;List of data tables for output. Accessed by output vduas $E0-$EF. 


740 






;N0T implimemed for Kelly's version 


741 


F851 




DATAAOR: 




742 






OW OATOO.OAT01 ;ete 


743 






.none 




744 










745 






; • * • Start of main part of rula tebla * 


746 






; Ivteximum number of rules is 1 28. named from $00 to $7F 


747 






; RULEOO ia fired at power up and restart. 


743 






; It should not be in active mode list. 


749 










750 






;RULE0O: 




751 






D8 40O + FIN 


;No previous rule (startup) + Final rule in list 


752 






08 NONE 


;No condifjona 


753 






08 $F0 


;lnvoka mode change to 0. but no output value to rr> 


754 




Of . 


08 901 


;Rule to start with in new mode. Thia byte ie unique 


755 








;to mode rules ($F0-F7). It IS NOT T1MEI 


756 








; BATTERY LOW (special rule does not appear to fire) 


757 






RULEOO: 


758 


F851 


80 


09 $00 + FIN ;No previous routes 


•tea 

753 


CBC1 


1 7 


08 ANL ♦ LTV + BATT ;Anaiog, Lass than. Battery 


760 


COM 

rob J 




BTVAL: OB $90 


;5.28 volts 


761 


F854 


CO 

ro 


08 $FB 


.Call subroutine 


7A7 










7A7 






RULE01: 


;START 


764 


cocc 
r855 




OB $05 


;#5 ; possible routes 


765 


COCA 

rood 


WO 


DB $06 


;#6 


766 


roa/ 




OB $09 




767 


coco 
rods 




08 $0C 


;#C 


7A0. 




90 


OB $10 + F1N ;#10 + Find 


/ OS 


CQC A 


10 


OB ANL * LTV ♦ KO ; Analog. Lass than, Knea 


77rt 


CQRO 
ro3D 


09 


08 $09 


jThroshold 


771 


F85C 


48 


08 $4B 


; Output value 




F85D 


OF 


OB $0F 


; Force rule F if... 


77*1 


F85E 


FA 


DB $FA 


;Time limit of 250 * 20 msec - 5.0 sec 


774 










775 






RULE02: 


;KNEE FLEXION 


776 


F85F 


01 


OB $01 


;# 1 ; possible routes 


777 


F860 


8F 


OB $0F>F1N ;#F * Final 


778 


F86T 


20 


OB ANL ♦ GTV ♦ KO ; Analog, Greater than. Knee 


779 


F862 


OA 


OB $0A 


;Threshold 


780 


F663 


57 


08 $57 


;Output value 


781 


F864 


oe 


OB JOE 


.Force rule E if ... 


782 


F865 


FA 


OB $FA 


;Time Hmit of 250 • 20 msec - 5.0 sec 


783 










784 






RULE03: 


;T0E LOAD (KNEE EXTENSION) 


785 


F866 


01 


DB $01 


;#1 possible routes 


788 


F367 


02 


OB $02 


;#2 . 


787 


F868 


OD 


DB $00 


:#0 
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F869 


0E 


D8 JOE 


:*E 


789 


F86A 


8F 


DB IOF + PIN ;#F * Final 


790 


F86B 


50 


OB ANL+CHN+LTV *K0 ;Chain. Analog. Less than, Knee 


791 


F86C 


OF 


OB $0F 


.Threshold 


70} 


F86D 


21 


OB ANL + GTV + LO .'Analog, Greater than, Load 


793 


root 


9 A 


08 )9A 


;Threahold 




FRAP 


32 


DB $32 


rOutput 


/95 




01 


OB $01 


.Force rule 1 if... 


/y o 




?A 


DB $2A 


.Time limit of 42 * 20 msec - 0.84 sec 


797 










798 






RULE04: 


; FLEXION 


799 


F872 


83 


DBJ03 + FIN ;f3 ♦ Final ;possibla route 


OUv 


F873 


20 


DB ANL ♦ GTV + KO ; Analog. Greater than. Knee 


on 1 

oU 1 


ro / ** 


1 B 


DB 91 B 


; Threshold 


on) 


F875 


32 


OB $32 


.-Output 


803 










804 






RULE05: 


.■TERMINAL aEXION 


fins 


F878 


84 


DB $04 + FIN ;#4 *■ Rnel possible route 


one 

sue 




58 


OB ANL + CHN '+ LTV > DVT +• KO ;Chein. Analog, Loee than. Derivative 


OU / 


F878 


FF 


DB-91 


:Threahold 


SAO 

QUO 


F879 


28 


DB ANL + GTV + OVT * KO ; Analog, Greater than, Derivative, Knee 


ana 




F3 


DB $E2 


;Thresho4d 


0 10 




T7 


DB $32 


; Output 


81 1 

ft! 9 






RULE08: 


.-STUMBLE 


fill 


F87C 


85 


DB$05 + RN ;*5 + Final ;poas»bJe route 


314 


F87D 


28 


OB ANL + GTV + DVT * KO ;Analog, Gf eeter than. Derivative, Knee 


815 


F87E 


02 


OB $02 


;Threahold 


316 


F87F 


53 


08 $53 


; Output 


817 










818 






RULE07: 


;SMALL HEEL LOAD 


819 


F880 


02 


08 $02 


;#2 possible routes 


820 


F881 


OC 


08 iOC 


;#C 


821 


F882 


8E 


DB $OE + RN ;#E ♦ Final 


822 


F883 


11 


08 ANL + LTV * LO ; Analog Less than, Load 


823 


F884 


3B 


DB 538 


;Threshold 


824 


F885 


57. 


D8 $57 


; Output 


925 


F886 


08 


08 908 


;Forc» rule 8 if... 


826 


F887 


32 


08 $32 


;Time limit 50 • 20 msec - 1 .0 sac 


827 










828 






RULE08: 


;SIT OOWN (forced) 


829 


F888 


80 


OB $00 + FIN ;No previoua routes 


830 


F889 


7F 


08 NONE 


;No conditions 


831 


F88A 


4E 


DB $4E 


; Output 


832 


F88B 


09 


DB 909 


;Force rule 9 if... 


833 


F88C 


64 


08 964 


.Time limit of 100 • 20 maec - 2.0 sec 


834 










835 






RULE09: 


;SEATED 


836 


F880 


80 


DB $00 + FIN ;No previous routes 


837 


FB8E 


7F 


OB NONE 


;No condiuone 


838 


F88F 


32 


D8 932 


; Output 


839 


F890 


10 


DB 910 


.Force rule 10 if... 


840 


F891 


FA 


DB $FA 


;Time limit of 250 * 20 msec - 5.0 sec 


841 










842 






RULEOA: 


; LARGE HEEL LOAD 


843 


F892 


87 


DB $07* 


FIN ;#7 + Final ;po«aibie route 


844 


F893 


11 


DB ANL + LTV +■ LO ; Analog, Less than. Load 
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845 


F894 


2A 




Do 9ZA , I nf OSnOIQ 


846 


F895 


57 




OB $57 ; Output valua 


847 


F896 


08 




Uo 5UO ,rorco ruio □ it... 


848 


F897 


32 




Uo ioa t • uTiO urmx 01 sv «w nine ™ i .w 


849 










850 






DIM CnDi 


,9 1 Ain ucducn i 


851 


F898 


80 




DB SOO + FIN ;No previous routos 


852 


F899 


7F 




Uo nunc ,no conaiuom 


853 


F89A 


49 




08 $49 ;0utput 


854 










855 






RULEOC: 


( 5TAIn 5WINU 


856 


F89B 


83 




Uo JUU + rinj »»D * nnu , possiot* roues 


857 


F89C 


10 




MM AMJI ilTVi^rt •AaaIasi 1 AAA *+«AA I^MAA 

uo ANL + LTv+ivU .Analog, loss man, isnaa 


858 


F890 


26 




DB >2o ;Tnrasnotd 


858 


F89E 


57 




08 $57 .Output 


860 










861 






RUIEOD: 


;rAL5c HctL LOAD 


862 


F89F 


07 




08 $07 ;#7 ;possibls routas 


863 


F8A0 


8A 




UO »U A t NN »JFA ▼ rinat 


864 


F8A1 


21 




DB ANL +■ QTV * LO ; Analog. Gf eatar man, Load 


865 


F8A2 


40 




MM AAA 'TkraahrtM 


866 


F8A3 


00 




0B $00 ; Output 


867 










868 






RULEOE: 


.QUI it MMVA7KJ 

;9HUT UUWN 


869 






RULEOF: 


,cui it nnu/M 


870 






RULE10: 


,eu< it rtrtu/w 
;onu l uuwn 


871 


F8A4 


80 




no Ann 1. eiAj «aja m^aaaaaia 

uo juu + riw ,no pravious 


872 


F8A5 


7F 




no MOMC •U m ammHimmma 

UO NUNC ,no conaiuona 


873 


F8A6 


00 




nO 4rtO -Mm Mtirntit 

uo iuu , no output 


874 










875 


F8A7 


FFFF FFFF FFFF 


□iii ci i . n w * peer *crce ipcce 4 FFFF 
nuui i* uw frrrr,#rrrr,f rrrr^rrrr 


F8AD 


FFFF 






876 


F8AF 


FFFF FFFF FFFF 


oi it PI }* Ow sFFFF SFFFF sFFFF sFFFF 
nwtc 1 *i ww *rrrr, * rr rr , » rrr r, #rrrr 




F8B5 


FFFF 






877 


F8B7 


FFFF FFFF FFFF 


RULE13: 0w $ FFFF, $ FFFF, $ FFFF, $ FFFF 




FSBD 


FFFF 






878 


F88F 


FFFF FFFF FFFF 


RULE14: Dw $ FFFF. $ FFFF, $ FFFF, $ FFFF 




F8C5 


FFFF 






879 


F8C7 


FFFF FFFF FFFF 


RULE15: Ow $ FFFF, $ FFFF, $ FFFF, $ FFFF 




F8C0 


FFFF 






880 


F8CF 


FFFF FFFF FFFF 


RULE! 6: Ow SFFFF, $FFFF,$ FFFF, $ FFFF 




F805 


FFFF 






881 


F8D7 


FFFF FFFF FFFF 


RULE 17: Ow $ FFFF, $ FFFF, $ FFFF, $ FFFF 




F800 


FFFF 







882 
883 
884 
885 
886 
887 

888 F80F 

889 F80F 7D0O17 

890 F8E2 26 OE 
891 

892 F8E4 15 12 40 

893 F8E7 4F 

894 F8E8 F6 F9 07 



blank 
blank 
blank 
blank 
blank 
blank 
blank 



additional rulaa would raquir- that RULNUM ba raisad, and additional 
bit fia4d bytaa for RULTIM and MOOExx ba addad & DW's for RULAOR's 



;Sut routines and 0/A tables would go hare if used. 

SUBOO: 

tat Stimo + 1 rrunning airaady? 
bna nobt ;v«s. don't mass up 

bclr <(curmbf),$40 ;taka ruia 1 out of scan 
dra ;no old beep command 

tdab BFVAL ;tha vaiua to baap 
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895 


F8EB 


00 30 






std Btima . ;new baepar command 


896 


F8E0 


CC 17 70 






Idd #6000 shutdown time out 


897 


F8F0 


97 16 






stee Stimo ;make it run 


898 


F8F2 


39 


nobt: rts 


899 












900 






;SUB01: 




901 






;0ATOO: 




902 






;DAT01: 




9U<J 


F8F3 




ENDJ3ASE: 


904 












9U9 


F8F3 








END 


906 






















equ PORTC :for now 


908 


1003 


OIGIN 


909 


1004 


DIGOUT 


aqu PORTB 


om 
a iu 












0 1 1 






• 






419 
9 I • 


F900 








org ROM ;Codo starts hare 


914 












9 1 # 












QIC 








Main Command Jump Table. Consists of Cmd byte followed by address to |sr 


41 A 








Searched sequential so put most liksiy commands first in list 


Q17 






; 01M1/91 Redefine dements & routines 


a i a 






» 






» I 9 


0OO3 


Esil 


equ 3 ;curront element size for CMOOISP 


450 






CMDT8L: ; A S At *Q are handled by Rxint/Txint 


7 4 1 










db SPC ; Eat character 


922 






» 




dw NULL 


923 


F900 


41 






db 'A' ; Adjust values in rule table 


924 


F901 


F045 






dw ADJUST 


925 


F903 


44 






db '0* ;Debuq. State & A/D veJue* in hex 


926 


F904 


FF80 






dw DUMP 


927 


F906 


45 






db 'E' ;enter values 


928 


F907 


FD2E 






dw ENTER 


929 










db 'P* ; Print something (debug aid) 


930 






» 




dw PRULS 


931 


F909 


12 






db 'R'~$40 ;*Roatan to power-up values 


932 


F90A 


FBE2 






dw BEGIN 


933 


F90C 


54 






db T ;Tune motor velues. Stops rules. Adjusts motor 


934 


F900 


F09F 






dw TUNE 


935 










db 'R # ;Recal! parameter set f 


936 






i 




dw RECALL 


937 


F90F 


53 






db *$' ;Save RAM to EE 


938 


F910 


FCAC 






dw SAVE 


939 


F912 


40 






db 'M* ;Memory dump ® address 


940 


F913 


FECE 






dw MEMDMP 


941 










db 7' ;Help. Display list 


942 










dw HELP 


943 










db *F ;Free up mods change 


944 










dw FREMOO 


945 










db V ;Lock to a mode 


946 










dw LOCMOD 


947 


F915 


46 






db 'F' ;Bags toggle 


948 


F916 


FFB3 






dw FLAGS 


949 










db T-S40 rTast 


950 










dw TEST1 ;tast routines 


951 


F918 


80 






db $80 rand of table character MUST be s80 
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952 
953 
954 
955 
956 
957 
958 
959 
960 
961 
962 
963 
964 
965 
966 
967 
968 
969 
970 
971 
972 
973 
974 
975 
976 
977 
978 
979 
980 
981 
982 
983 
984 
98S 
986 
987 
988 
989 
990 
991 
992 
993 
994 
995 
996 
997 
998 
999 
1000 
1001 
1002 
1003 
1004 
1005 
1006 
1007 
1008 



F919 

F919 3C 

F91A FEFB 

F91C 3E 

F910 FEF7 

F91F 1B 

F920 FE5E 



F922 30 

F923 FEFF 

F925 2B 

F926 FD80 

F928 20 

F929 FD82 

F92B 3A 

F92C F073 

F92E 80 



RTTBL: 



rtai time 


table for real tima commands 


db '<* 


;dec var 




dw DECVAR 


db *>' 


;inc var 




dw INCVAR 


db ESC 


; escape loop 




dw ESCEXIT 


db ' ' 


foscape 


dw ESCEXIT 


db V 


; escape 


dw escexit 


db 


;direct assignment 




dw SETVAR 


db 


;inc address 




dw INCADR 


db 


;dac address 




dw OECADR 


db ':' 


;set address 




dw SETAOfl 


db $80 


.-end of table 



; RTDSPH. reel time dispatch. 

; < > inc/dsc value, +■ • incMec address being modified 

• Returns to one ABOVE caller if ESC, SPC. entered. 

; Echbs veriable value for each step 

; falls into CMOOISP 

; X is callers address on return to MAIN 



F92F 

F92F CE F9 19 



RTDSPH: 

Idx #RTTBL 
.FALL INTO CMOOISP... 



;Real Time commend TaBLe 



;CM0DISP. commend dispatch from table of input chare - > 'addressee 
;X points to table heed. A has char to check for match. 
: If $80 at end of table found, sets Carry. CMO not found. 
; X L B altered initially. Commands do whatever... 



F932 

F932 C6 03 

F934 20 01 

F936 3A 



F937 

F937 60 00 

F939 28 OA 

F93B A1 00 

F93D 26 F7 



CMOOISP: 



cmdnxt: abx 



tdeb fEsii :Qat element sue for loop use 

bra emdlp ;to middle. Fewer branches inside loop is fastar 

;add 8 to X to get to next table entry 



;; may be able to uee $80 ee flag & bvs to find end 
emdlp: 

tat 0.x ;and of table is $80 

;yea. Cmd not found 



;byte match? 
;get next entry 
preload for toggle functions 



cmpe 0.x 
bvs cmd err 



Idab #1 
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10 



1009 
1010 
1011 
1012 
1013 
1014 
1015 
1016 
1017 
1018 
1019 
1020 



F93F 
F941 



EE 01 
3C 



F942 DE 4B 



F944 39 



Idx i tX ;gat address of found command {@X + 1) into X 

pshx ;save on stack 

Idx Adjodr ;proloed for smaller RTDSPH code size 



F945 
F946 



00 
39 



imp 0.x 
rts 

cmderr: sec 



.page 



;and do it. Colled procedure does rts to main loop 
; which is really a jump to table entry on stack I 

;set carry 
.-return with error 
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15 



20 



25 



30 



35 



40 



1021 






1022 






1023 






1024 


F947 




1025 


F947 


CE 10 00 


10 26 


F94A 


10 23 7F 


1027 






1028 










V 


1029 






1030 






1031 


F940 


1C 00 80 


1032 






1033 






1034 






1035 


F950 


3C 


1036 


F951 


CE 00 50 


1037 


F954 


C6 08 


1033 






1039 


F956 


1 A EE 08 


1040 


F959 


1A EF00 


1041 






1042 


F95C 


08 


1043 


F95D 


08 


1044 






1045 


F95E 


5A 


1046 


F95F 


26 F5 


1047 






1048 






1049 


F961 


38 


1050 






1051 






1052 






1053 






1054 






1055 


F962 


1 C 30 04 


1056 






1057 






1058 






1059 


F965 


EC 31 


1060 


F967 


00 60 


1061 






1062 


F969 


EC 33 


1063 


F968 


00 62 


1064 






1065 










V 


1066 






1067 






1068 


F96D 


EC 16 


1069 


F96F 


C3 9C40 


1070 


F972 


ED 16 


1071 






1072 






1073 


F974 


r 

DC 70 


1074 


F976 


27 13 



TIMe INT. OCT ints here to get work done 
TIMINT: 

tdx #REG ;Base 

bdr JTFLG1 ,x,57F ;0C1 int fig cleared if high, R/M/Write 

;smco we should be able to do thie in under 20meec, we'd reeneble inte & pre 

cli ; allow others to int (SCI mostly 'or debugging) 

beet _PORTA.x.S80 ;dbg raiee nag 0C1 for timing 

bar fsatx ;dbg raise Hag. X ok. 

; ■ • • FIFO function shuffles old data in ram to make room for new. 
pshx ;seve #rsg 

Idx #Fifo ; start here 
Ideb f 0SIZ/2 :looo count 



?mvdta: idy OS 12/2, X 
sty O.X 



inx 
inx 



decb 

bne ?mvdta 



;get 2 bytes from here & 

;stuff here (FIFO rune toward lower mem) 

;move pointer up 



; count down 
;until done 



Idx #R£G 
pulx 



.'reload register beae for speed/size 
;recover #REG 



bclr J>ORTA.x.*80 :dbg meeaurement 

bsr fclrx ;dbg deer flag, X ok 

;<§> we may went ONE pees on 4-7 to minimize skew between channels 
beet _ADCTUx.*4 ; change A/D to 4-7 repeating 
Idea #114 ~ :change A/0 to 4-7 ONCE 
stae _ADCTL.X .now 

Idd _ADR1 .x ;get ADR1 ,2 data. A/D must be done after 20msec. 
std Anklet .stuff 1,2 

Idd _ADR3.x ;get A0H3.4 
stdAnldat + 2 .stuff 3.4 

; since we should be able to do this in under 20meec, we'U reanabte inta 4 pre 

cli .allow others to int (SO mostly for debugging) 

idd JT0C1 ,x .current time of int 

eddd fRTCRAT ; 20 msec ;$use Rem value? 

std _TOC 1 ,x .update compare time 

;<9 this code should be changed to uae the OCx to reiae the output, ocl to dee 



Idd Mtimo 
beq nopul 



; motor width 
:zero 
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70 



75 



20 



25 



30 



35 



40 



45 



1075 
1076 
1077 
1078 
1079 
1080 
1081 
1082 
1083 
1084 
1085 
1086 
1087 
1088 
1089 
1090 
1091 
1092 

1093 
1094 
1095 
1096 
1097 
1098 
1099 
1100 
1101 
1102 
1103 
1104 
1105 
1106 
1107 
1108 
1109 
1110 
1111 
1112 
1113 
1114 
1115 
1116 
1117 
1118 
1119 
1120 
1121 
1122 
1123 
1124 
1125 
1126 
1127 
1128 
1129 
1130 



P978 E3 OE 

F97A C3 00 OA 

F97D £0 13 

F97F 86 CO 

F981 A7 20 

F983 86 40 

F985 A7 OB 

F987 86 80 

F989 A7 20 

F98B 

F98B OE 



sal 

F98C EC 31 
F98E 00 64 

F990 EC 33 
F992 00 66 

F994 1 0 30 04 



F997 18DE16 

F99A 27 1 5 

F99C 18 09 

F99E 18 OF 16 

F9A1 26 OE 



F9A3 
F9A6 
F9A9 
F9AB 
F9AD 
F9AF 



1 4 41 80 
B6 F8 06 
C8 01 
00 1C 
C6 09 
07 3E 



addd _TCNT,x 
addd #10 
3td J"0C2.x 

Idaa f SCO 
staa JTCTU.x 

Idaa #340 
•taa JTFORC.x 

Idaa #980 
staa TCTLI.x 



;odd to currant time 
.compensete for software delay 
.updata ouput compare rag 

; * 0C2 goes high on compare 



;OC2 force bit 
.Force 0C2 high 

;ne« 0C2 will go low 
.-whenever 



nopui: 



cli 



;can now allow ints here so PW doesn't jitter 



;?wtadO: brclr _ADCTL.x.$80.?wtadC ;wait for A/0 done (just in ca 



fdd AORl.x 
std Antdet + 4 

Idd _A0R3\x 
std Anidat + 6 



;get A0R1.2 
;stuff 4.5 

:get A0R3.4 
:stuff 6,7 



bdr ADCTUx.504 ;restart A/O to CH 0-3 for 18Msec from now 

Idea #930 ;chenge A/D to 0-3 Repeating 

staa _A0CTL.X ;now 

bset _P0RTA,x.$80 ;dbg timing 

bar faetx ;dbg aet flag. X ok 

; • • • Beeper chock 

; @ use X if possible & reload later 



Idy Sbme 
baq 7batst 

day 

sty Slime 
bna 7batok 



; timing beep? 
;nope 

; count out 

;update ram 

;not YET timed out 



beat Rag2,MLTFLG ;stop ruJes 

Idaa BRUL ;tha rule 9 to force 

Idato #1 ;in one tic 

std Frcru* ; stuff here 

I dab #5 .new beep 

stab Btime + 1 ;and shut up beeper with a longer chirp 



ctrb 

bra cbeep 
bra ?batok 

Idob MSAFE 
jar LD_MOTOR 
bra 7batok 



:need zero 

;and shut up beeper 

;skip onward 

; safety value 
;do it now 
;skip onward 
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1131 






1132 


F9B1 




1133 






1134 






1135 






1 1 30 






1137 






1138 






1139 






1140 






1 141 






1142 






1143 






1144 






1 14S 


F9B1 




1146 






1147 






1148 






1149 






1150 


F9B1 


06 3E 


1151 


F9B3 


27 2£ 


1152 






1153 


F9B5 


01 3D 


1 1 54 


F9B7 


26 IE 


1155 






1150 






1157 


F9B9 


18 0E 23 


1158 


F9BC 


18 09 


1 159 


F9BE 


18 OF 23 


1160 


F9C1 


26 20 


1 161 






1162 










time 


1163 


F9C3 


IE 08 20 1 


1164 




time 


1165 


F9C7 




1166 






1167 


F9C7 


1C08 20 


1168 






1169 


F9CA 


54 


1170 


F9CB 


54 


1171 


F9CC 


54 


1172 


F9C0 


54 


1173 


F9C£ 


26 03 


1174 






1175 


F9D0 


7F 00 3C 


1176 






1177 


F903 


17 


1178 


F904 


30 


1179 






1180 






1181 






1182 






1183 






1184 






1185 







id a a AnJdet «► 3 ;the battery channel 

cmpa BTVAL ;the threshold in EE 

bha ?batok jiot too low yet 

Idd #6000 ;2 minutee 

std Some ; setup timo out 

Idaa BVAL ;get command 

staj Btime* 1 ; startup beeper 

Idd BVAL ;beep value & repeat 

std Borne -»- 1 ;emd & repeat count 



?batok: 



; • • • * Beep: handled here 

;@ This can be improved (how?) 



(dab Btime ♦ 1 .get command byte 
baq ebeep .-nothing happening, return 

cm pc Btime .-compare with previous comm an d 

bna ton .-command changed. Start with on time*, aat counter 

;?rtchg: ;no change, must sin* bs timing 

Idy Rtime ;get counter 

day .count down 

sty Rtime .-update 
bna ebeep ;conanue. time not up yet 

25 1 162 brclr BPORT- R EG, x.BBJT, ton ;gnd if beep currently off, compute on 

) brset BP0RT-REG,x,B8IT,ton ,*v + if besp currendy off, compute on 

ebeep: 

30 bdr BPORT-R EG ,x BBIT .clear beeper bit 

beat BPORT-REG.X.BBIT ;doar baspar bit 

?toff: Ism ;shitt 'OFF' time to low rrybbJs 

lam 
Isrb 
lerb 

35 1173 F9CE 26 03 bna off ok :we do have en off time, else we're done. 

clrbt: dr Btime ♦ 1 ;dest command. Dons for now. (fall through for size) 

; Btime + 1 » zero prevents beep timing until cmd changes 
offok: tba .copy 

mul .-time squared 

40 1179 Was #10 ;10 VO 20 - .2 sec tics 

mtrt .-times low order in B 

std Rome .'update counter 

bra ebeep ;cleer beep 



;& we could do repast count down here 
;& Idas Ctime .-get count 
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1 186 






;& boq ?mu!10 ;wo don't havo a count 


1 1 87 












11 88 






;& decs 


;count out 


1 189 






; A staa Co mo .-update 




1190 






;& boq clrbt rtimed out. stop update, else 


1191 












1 192 


F905 


20 07 




bra mul10 


;continue with common code 


1 193 












1 194 


F9D7 




ton: 






1 195 






bset BPORT-REG.x.BBlT 


.turn on beeper bit 


1196 


F907 


ID 08 20 




bdf BPORT-REG,x.BBiT ;turn on beeper bit 


1 197 


F90A 


07 30 




stab Btime 


;update command change byte 


1198 


F9DC 


C4 OF 




andb #30F 


;mask to low order nybblo 


1 199 












1200 


F90E 


86 OA 


muMO: 


Idea #10:10' .020-.2aec b'ca 


1201 


F9E0 


3D 




mul 


.compute 


1202 


F9E1 


DO 23 




aid Roma 


.update/start counter 


1203 












1204 






ebeep: 


:end of beep function* 


1205 












1206 












1207 






. • • • • njja timing. 


Do we need to check SFLG? 


1208 


F9E3 


DC 1C 




Idd Frcrul 


.gat forcing info, rule f h rima 


1209 


F9E5 


50 




tatb 


;dmar running? 


1210 


F9E8 


27 08 




beq ?nfrct 


;nopo. no forced time active 


1211 












1212 


F9E8 


7A 00 10 




dec Frctim 


;count down timer in RAM 


1213 


F9EB 


28 06 




bne ?nfrct 


;not yet timed-out 


1214 












1215 


F9ED 


97 20 




staa Scnrul 


;force thia rule (A from LDD) 


1216 












1 217 






tdae *"T' ;dbg 




1218 






jar dbg 


;'T 




1 219 












1 220 


F9EF 


80 50 




bar FORCER 


;maka it active NOW 


1221 












1 222 


CQC1 

F9F1 


ns\ no 
Zv Uo 




bra endtim 


;skip to end. only one rule Tired per Ocl int 


1 223 












1 224 


COM 


oa at 


Pnfrct: !< 


iaa #<HITRG + TFLG ♦ SFLG) .-flags to check 


1 225 


F9FS 






bite Reg2 


;in here 


1 xZO 


CQC7 


26 08 - 




bne norula 


.-blocked by tune or scan or HALT (ban low) 


















U 11 02 




baet Rag2.5FLG 


.prevent recuraive calls to scan 


1 2 29 












1 Tin 






; bdr Rag1,DBRG,?dacn 


;dbg 


1 231 






jtr CRLF ;dbg acan 




1232 






Idea ICR ;dbg 




1233 






bar dbg 


;cr 




1234 












1235 


F9FC 


8D 08 


?dtcn: 


bar SCAN 


; jean rules if not recursive interrupt 


1236 












1237 


F9FE 


15 41 02 


ondtim: 


bclr Rag2.SFLG 


;dear the scanning flag, or forcer deadlock 


1238 












1239 


FA01 




norula: 






1240 






; bar fcir 


;dbg timing 




1241 


FA01 


CE 10 00 




Idx #REG 


.recover base 


1242 


FA04 


10 00 80 




bclr _P0RTA.x.S80 ;aJweye end INT with OC1 daarad 



0548855A2 J > 
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10 



1 243 PA07 33 done this inttrrupt {appro* 1 .5msee total) 

1244 

U4S ; 

1 246 .timing measurement flag for debugging/refinement 

1 247 ;fclr: 
1 24« ;fsat: 

1 249 Idx *REG ;b«ae 

1 250 .feint: 

1251 ;fsetx: 

1 252 Wee _P0RTA,X :get flag 

1253 eoraf$80 ;flip 0C1 
1 254 «aa _PORTA,X ; stuff it back 
1255 

1256 tst_PORTA,X ;sign? 

1 257 bp* fe ;rai»e since down 
1258 

1259 bclr J>ORTA,x.$80 ;loworOC1 output 

15 1260 :; RTS*" 

1261 

1 262 :;fset: idx #REG ;baae 

1 263 ;;fsatx: 

1264 ;;fs: bsst _P0RTA.*.*8CL :raiae OCT output 

1265 FA08 39 

20 1266 ;15 bytes v« 10 

1267 

1268 ; 

1 269 ;SCAN. Scans rules & generates outputs 

1 270 ; Modifies ell registers 

1271 : 1/29/90 

25 1272 : 

1273 db'SOT ;dbg 

1274 PA09 SCAN: 

1 275 rts 

1276 FA09 7F00 20 clr Scnrul ;clr counter 

1277 FAOC 15 41 40 bcir Rag2,FRFlG .clear 'R red s Rule' flag 
1278 

1 279 Idx IMOOEOO ;f rom eprom during debugging 

1 280 FAOF CH 00 1 2 Idx #Curmbf .from ram table 
1281 

1282 FA 12 A6 00 ?getbf: Idea 0,x ; get active rules bit field 

1 283 beq ?nxtt)f ;skip if none at aH. ;low probebility, not enabled 
1 284 

35 1285 FA 14 48 Jshrbf: asia ;bits into carry 

1286 FA IS 24 08 bec ?nruls .this rule not ective 

1287 

1288 FA 17 3C pahx ; this ml a active, stack 'am 



30 



1289 FA18 36 

1290 bsrfset ;dbg 
40 1291 

1292 FA 19 80 36 bar GETRUl : and chack rule conditions 

1 293 bar fdr ;dbg 
1294 

1295 FA IB 32 pula :recovef em 

1296 FA1C 38 pulx 
46 1297 

1 298 FA 1 D 1 2 41 40 1 6 brset Rag2.FRFUG.nxt ;fired e rule. Only one per int so skip out 

1 299 ;next call to scan wtU deer FRFLG 
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5 v 



70 



15 



20 



25 



30 



35 



40 



1300 

1301 

1302 

1303 

1304 

130S 

1306 

1307 

1308 

1309 

1310 

1311 

1312 

1313 

1314 

131S 

1316 

1317 

1318 

1319 

1320 

1321 

1322 

1323 

1324 

1325 

1326 

1327 

1328 

1329 

1330 

1331 

1332 

1333 

1334 

1335 

1336 

1337 

1338 

1339 

1340 

1341 

1342 

1343 

1344 

1345 

1346 

1347 

1343 

1349 

1350 

1351 

1352 

1353 

1354 

1355 

1356 



FA21 

FA22 

FA 24 
FA27 



40 

27 05 

7C 00 20 
20 EB 



FA29 08 



FA2A 
FA2C 
FA2E 
FA 30 



FA32 
FA35 



06 20 
C4 F8 
C8 08 

07 20 



F1 F8 08 
23 08 



FA37 39 



FA38 
FA39 



FA3A 
FA3D 

FA3F 

FA42 



CO 
02 



F1 F8 09 
23 07 

CE FA 39 

80 FE 71 



FA45 SF 



FA4« 
FA49 
FA4A 
FA 43 
FA40 



CE F8 1F 

58 

3A 

EEOO 
39 



ista 

?nrulo: beq ?mctbf 

inc Scnrul 
bra ?shrbf 



?nxtbf: inx 



(dab Scnrul 
andb #*F8 
addb #38 
scab Scnrul 



tba 

jsr HOUT 



;dbg 
;dbg 

cmpb NUMRUL 
bla ?gettof 



;sot CCs 

.nothing loft in rag so gat next byta 

;next scan rule $ 

;& chock for active status 

;noxt bit field 

retrieve it 

;mask out partial counts (0-7) 
;incromont to naxt whole byta of BFs 
;put it beck 



;hit limit? 

;nopo. go check next BF byta 



;donerul: 



Idee #V ;dbg 
isr 0UTJ3C 



:dbg 



;done thia pass. 



;mossagoa sit hero for bsr limits 

mdemsg: db "M" + 580 ;mode error 

rormsg: db "R" * 580 ; error mesage here for bsr 

; • • * Subr to get EE addrass Sf rules (not rem) 

GETEDR: cmpb MAXRUL :iimit to present maximum rule 

bis ?mok ;ok (unsigned, but since 7f max. needn't be! 

Idx frermsg ; error 

bsr mdeout indirect jmp to PMSG 

jar PMSG ;toil 'em 



Idao MAXRUL 
IdabfO 

Cirb 



;iimit it to?? 

;iimit to power up rule since we have an error 



?mok: Idx JRULAOR 
aelb 
abx 
Idx 0,x 
rta 



.table start in EE 

; ■ 2 for word a 

;index into eddreee tabie 

;get addresa into x 

;done 



FA4E 14 41 12 



FORCER: 

tdaarf rdbg 
bsr dbg 



bset Reg2,FFlG ♦ SFLG 



;1 



;set Forced & Scanning flags 



;we don't want to stack things up if He goofs and gats an infinite loop of 

.forced ruiae so that we jump around & around & around k 

;so we fall into... 

jmp GETRUL ;forca the rule search. 
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1357 






1358 






1359 


FA51 




1360 






1361 


FA51 




13S2 






1363 






1364 






1365 


FA51 


06 20 


1366 






1 367 


FA53 


8D £5 


1 368 


FA55 


9C 10 


1369 


FA57 


26 03 


1370 






1371 


FA59 


CE 00 00 


1372 






1373 






1374 






137S 


FA5C 


15 41 04 


1376 






1377 






1378 






1379 






1380 






1381 






1382 






1383 






1384 






1385 






1386 


FA5F 




1387 


FA5F 


E6 00 


1388 


FA61 


C4 7F 


1389 


FA63 


27 04 


1390 






1391 


FA65 


D1 19 


1392 


FA67 


26 03 


1393 






1394 


FA69 


14 41 04 


1395 






1396 


FA6C 


60 00 


1397 


FA6E 


08 


1398 


FAAF 


2B02 


1399 






1400 






1401 


FA71 


20 ec 


1402 






1403 


FA73 


12 41 10 


1404 


FA77 


13 41 04 


1405 


FA7B 




1406 






1407 






1408 






1409 






1410 






1411 






1412 







;will return to cellar after rule fire* (we hope) 
; since FRFLG set too, getrul return* quickly too. 

<. 

;• *subr to get rule from table, check conditions, end fire output & timer 
GETRUL: 

bsr getscn ;get the rule's address 

***** subr gets addrsss of rule at Scnrui. Sits here for BSRs limits 
gatscn: 

Id oo Scnrui ; scanned rule # 

;GETADR: 

bsr GETEDR ;get EE rule address 

cpx Srcadr ; compare to address we may have in ram 

bne ?rsok ;ok 



sec 

;?raok: rts 



Idx IWrkrul ;N0. here is where THIS rule ia 

;and tail them so 



dbg 



7rsok: bcir Reg 2. P FUG ;cir path found flag 
. brdr Rag 1 ,DBFLG , getpsth ; dbg printout 



jsr H0UTC2 
Idea Scnrui 
jsr HOUTS 
ns 

bra gstpath 

db "GP- 



;newriine & address 
;get rule f 

;print it 
;dbg 
:dbg 
:dbg 



gstpath: 



Idab 0.x ;gat paths byte 

andb #*7F ;ma*k out FIN flag 



bag 7pzero 



> Currui 
bne ?nmteh 

?pzero: beet Rag2,PFLG 

?nmtch: tst 0,x 
inx 

bmi ?lstph 

irat 



.path of zero spedall, no previous req'd:. Path found 



rCurrent rule? 



;found a path 
;F1N flag? 

;% point to next path, only 2 CC effected 
rye*, last path 



.point to next path 
bra getpath .loop 



?tvpth: 



ttstph: brset Rag2.FFLG,?fvpth 
brdr Reg2.PFLG.nxt 

Idea #V 

bar dbg ;p 



;fofce valid path if sat 
.had NO PATH. RTS 



% inx ;naxt up 

* " Check FLAG Bit field & byte 

pshx ;sava current pointer 

Idx JRULRG ; FLAGS bit field 
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30 



1 41 3 . j sr BFSCN ;check flags bit fields for rule 9 in Scnrul 

1414 

pu ix .'recover pointer 

; bee 7dtat ;no flegs to check. Teet for digital condition 



1415 
1416 
1417 
1418 



, : @@ NEED TO ADD a Force flag teet here, but no room for code 

. 419 breet Reg2.FaG,?fvflg ,-force valid flege if set 

\ l 2Q ; @ aJao need to change to eame style ee digitd rulee. ACTIVE bite & VALUES 

, 421 ; <§> could then uee subroutine for both too. 

1422 

14i3 Idea 0.x ;get the date byte 

10 1424 andeRag3 ; AND in current fl age 

- eoreRag3 ;ffip sense of HOT bits 

J 4 * fl ; bnenxt condition not matchad. RTS 

1427 

1428 ;?fvflg: inx ; skip to next condition 

1429 FA7B E6 00 ?dtsn Idab 0.x ;next condition byte 

75 1430 FA7D 2A13 ****** .-Analog if MSB- 0 

1431 

1432 FA7F digrul: 

1 433 k*aa #'d' ;dbg 

1434 bar dbg ;d 

20 1436 FA7F F4 10 03 «ndb DIG IN ;ANO in external data with loaded mask 

1437 FA82 E8 01 ? «* ' fli P " nse tttl " 'P* 0 '* 1 

1 438 FA84 E4 00 «"«*b °>* thwn to ° fof '°b«« neM 
1 439 

440 FA86 08 .point to analog next, skip to «enaa byte 

1441 FA87 08 i« ; end eneiog condiiione 

25 1 442 FA88 1 2 41 10 04 braet Reg2.FFlG.anlget ;forca valid digital, check on analog 



1443 
1444 
1445 
1446 
1447 



FA8C C4 7F andb#«7F ;maak out DIG bit 

FA8E 26 A7 bna nxt ;Condition not matched, gat next rul (juet an RTS) 

FA90 ES 00 enlg«r. Idab 0.x ; get eneiog condittone 



1449 FA92 anlrul: 

1450 ldaa#V 

1451 ; bar dbg ;a 
1452 

1453 FA92 CI 7F cmpb #NONE ;chack for don't care 

35 1 454 FA94 27 4C fires ;don't care analog cond. so special fire 

1 4 g 5 ;no treshold fottowa this condition! 

1456 FA96 12 41 10 3F »r««t Rag2.FFlG,nxtcnd ;force analog 

1 458 FA9A C4 OT #*0F ;mask to channel bits only 

1 459 FA9C 3C pahx :sava pointer 

40 1460 : 

! 4^1 ; hare we put CHNTBL transistor 

1462 [Oil ifdaf TRANSLATE .Transistor enabled 

1 tba :*ave for bit teats 

1444 andb #$07 ;just A/0 ch # bita 



1465 Isrb ;into nybble 

1 455 !dx fCHNTBL translate table 

1 46 y abx ;index into table 

1468 

1469 Web 0.x ;new value 
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1470 






bit* #$1 ;odd/avan nybbla? 


1471 






beq ?chevn 


;avan .xhanga to bna to awap nybbJaa around 


1472 










1473 






larb 


:shift into low nybbla, 0 fill (NOT ASRM) 


1474 






larb 




1475 






Isrb 




1476 






larb 




1477 










1478 




?chavn: bita #0VT 


;58 ;dsrivabva7 


1479 






baq ?ehok 


;no. usa aa ia 


1480 










1481 






orab #OVT 


;r»aa thia bit. (off aat CH addraaa by 8) 


1482 




7chok: andb #»0F 


;koep within bounda (kill any high nybbla rssidua) 


1483 




;30 bytaa if Y. 27. if X 




1484 


(001 


andif 




1485 










1486 










1487 


FA9D 


CS 08 


bitb #$8 ;0VT7 


1488 


FA9F 


27 03 


b«<q ?nodvt ;nopa 


1489 






bra ?nodvt 


:dbg 


1490 










1491 


FAA1 


BO FB 92 


jar DERIVE ;sat darivativa for THIS channal into ram tabla 


1492 










1493 


FAA4 


CE 00 60 


?nodvt: tdx #Anidat ranalog data tabJo 


1494 


FAA7 


3A 


abx 


; add in off aat to channol 


1495 


FAA8 


E6 00 


Idab 0.x 


;gat data valua 


1496 










1497 


FAAA 


38 


puix 


;rtcovar pointar 


1498 










1499 






brdr O.x.DVT^nobug :dbg only OvT inatnjctiona 


1500 






pahx 


;dbg sava pointar 


1501 






lda« 1 ,x ;dbg gat throahofd 


1502 






xgdx 


:dbg swap to X 


1503 






jar H0UTC2 


;dbg and print 


1504 






xgdx 


;racovar B 


1505 






pulx 


;dbg racovar pointar 


1506 






?nobug: 


;dbg 


1507 










1508 


FAAB 


El 01 


cmpb 1 ,x ;compara with threshold and branch aa raquirad 


1509 










1510 










1511 






0 wt might try a data tabla, index ad by 3 bit offaot 


1512 






currandv branch coata 5 * 


4 bytes -20 v* 8 • 2 addraaaaa +indax ovarhaad 


1513 






• or 




1514 






?nodvt: 




1515 






1 pahb 


;sava charmala 


1516 






•2 Ida #3 


; off aat par branch 


1517 






;1 mu* 




1518 






;3 addd #7b00 


;baaa 


1519 






:2 xgdy 


;to Y 


1520 






;1 pulb 


; racovar channaia 


1521 










1522 






Idx fAntdat 


; analog data tabla 


1523 






abx 


;add in off aat to ehannal 


1524 






Idaa 0.x :gat data valua 


1525 










1526 






pulx 


; racovar pointar 
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10 



75 



20 



25 



30 



35 



1527 

1528 

1529 

1530 

1531 

1532 

1533 

1534 

1535 

1536 

1537 

1538 

1539 

1540 

1541 

1542 

1543 

1544 

1543 

1546 

1547 

1548 

1549 

1550 

1551 

1552 

1553 

1554 

1555 

1556 

1557 

1558 

1559 

1560 

1561 

1582 

1563 

1564 

1565 

1566 

1567 

1568 

1569 

1570 

1571 

1572 

1573 



FAAD IE 00 30 19 

FAB1 1E00 18 18 

FAB5 16 00 10 08 

FAB9 IE 00 28 13 

FABD 1 E 00 20 06 



FAC1 27 16 

FAC3 39 

FAC4 25 13 

FAC8 39 

FAC7 22 10 

FAC9 39 

FACA 26 00 

FACC 39 

FACO 20 OA 

FACF 39 

FAOO 2E07 
FA02 

FAD2 39 



cmpe 1 .x ;cpmpare with threshold and branch required 

3 imp O.Y ;check tham 

» 13 ♦ 6 for 2 more beq/bne. rts for dvt, may not be faater either. 

breet 0.x.$30.?b1 10 ;thie wey N£V. MUST last BOTH bits FIRST 

;ok for DVT too 
brset0.x,$18.?b011 ;thie way LTV DVT 

brset0,x,$10.?b010 ;tWe way LTV - BLO 

brsat 0.x.l28.?b101 .this way GTV DVT 

breet 0.x.$20,?b100 ;this way GTV - BHI 

brclr 0.x.$30,?b000 ;thia way EQV. fails through. 

;ok for OVT eJso 
;Wa use hard coded vetuea rather than dafined conatanta 
: since code ■aquenoe dependenciee exist 
;but the following branch chain sorts it all out 



?b000: 



baq nxtend 
rts 



.condition ok. check for mors 
; condition NOT MET, try nextrul 



?b010: bio nxtend 
na 

?b100: bhi nxtend 
rts 

?b1 10: bne nxtend 
rts 

?b01 1 bit nxtend 



7b101 bgt nxtend 



; signed for DVT 



;signed for DVT 



nodbg: rts 



this is here to allow bar's for debugging 
dbg: brclr Ragl.DBFLG.rtodbg ; no debug 
imp 0UT_QC ;echo chars & return 



FAD3 CE FA 38 
FA06 7E FE 71 



isita here for bsr's 

mth: Idx fmdemsg 
mdeout: jmp PMSG 



; ©ERROR ERRORI mode too high for table 
;so print out, and abort ohenge 



FAD9 IF 00 40 04 



nxtend: brcir O.x.CHN.firea 



;chein?-l40 No, fire analog if wa got this far 



40 



45 



1574 

1575 FAOO 08 

1576 FADE 08 

1 577 FADF 20 AF 
1579 

1579 FAE1 08 

1560 

1581 

1582 FAE2 08 



inx 
inx 

bra snigat 



firea: 



; special caaa, no conditions 
fires: inx 



;yas. point to next sat (cond 1) 
: (art 2) 
;and check it 

.point to output byte (teat cond) 



: (output) 
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1583 
1584 

isas 

1586 
1587 
1588 
1589 
1590 
1591 
1592 
1593 
1594 
1595 

1596 
1597 
1598 
1599 
1600 
1601 
1602 
1603 
1604 
1605 
1606 
1607 

1608 
1609 
1610 
1611 
1612 
1613 
1614 
1615 
1616 
1617 
1618 
1619 
1620 
1621 
1622 
1623 
1624 
1625 
1626 
1627 
1628 
1629 
1630 
1631 
1632 
1633 
1634 
1635 
1636 
1837 



Ida* #T ;dbg 
bsr dbg 



; ignite 



FAE3 DC IF 



FAE5 40 

FAE6 27 05 

FAE8 01 1E 

) 

FAEA 20 01 

FA EC 39 
FA ED 

FAED 50 

FAEE 27 OB 

FAFO D7 19 

FAF2 7F00 1D 



FAF5 14 41 48 
FAF8 15 41 10 



FAFB 
FAFE 



86 10 29 
B6 10 2A 



FB01 58 

FB02 58 

FB03 58 

FB04 F7 10 2A 



FB07 OF 1A 

FB09 EC 00 

FBOB 81 FC 

FBOO 25 17 

FBOF 27 OB 

FB11 81 FE 



IdM SenruJ ;we want to b« here 

Idd Inhom ;we want to be here (8 -Sennit foUowe Inhtim) 

cmpb Curnjl ;w» ara currently hara 

baq ?nfire ;same as last time so skip firing coils 



tsta 

baq ?kfire 

cmpb Inhnjl 

bna ?kfire ;nop« 
bra 7kfire 



?Vfua 



?nfire: rta 
cmpb #1 



;lnhtim ie? (A of LDD inhtim) 

;no i 



;doee our scan nils match the inhibited rule?{B«Scnrul 
;dbg wa don't cars 

;wa didn't REALLY fire the rule. Look at next one 



; special rule? 
tstb ; special rule? 11/12/91 

baq noeee ;yee. don't let anyone (except SP1) sea it fire 



stab Curnjl ;so tall everyone of new at la number 

dr Frctim ;naw rula, daar timar. 

clr Inhtim ;and inhibits? If inn & othar fires, do wa atay inh'd? 



baat Reg2,CFLG + FRFLG .tall bkgd & scan of rule number change 

bdr Rag2.FFU3 .and clear forcing flag 
;<S> thara ia a logical inconeietency hara. Fflg cannot be cleared hara. 
;Q and then uaed for testing juet before domodel 
:<9 No moda change muet mean no moda change on forced rules too. 
;$ an interesting trap. So how do you gat into a moda you want to lock to? 



write rule # to D/A port via 3 PI 
noaee: Idea SPSR 
Idaa SPOR 

Ids* Cumi 



stab SPOR 



tba 

jar HOUTS 



;dbg 
;dbg 



ttx Outadr 

Idd 0.x 
cmpa #$FC 
Mo no tap! 

baq flgsat 

cmpa IIFE 



;;Knock down any SP1 
;;and dump any read data 

;get the rule that fired (stab Currul above) 

*2. 1 28 max (scale up output) 
;: '4, 64 max 
;; -8. 32 max 

;; write to SP1 port. 



;sava address of output value for gomer 

;gec output value (A) & byte following (B) 
.lower than? 
;not special 

.flagset function ()FQ 

; Beeper? 
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1638 


F813 


22 36 


bhi digou . ;Oigitall OFF) 


1639 








1640 


FB15 


25 09 


bio flgclr ;flagcir function (5FD) 


1641 






.BEEPER ;aqueJ (5FE) 


1642 


FB17 


4F 


?beep: clra ;deer out old command {@Btime) 


1643 


FB18 


00 30 


std 9bme ; startup baep timar with data byte B & no old command 


1644 


FBI A 


20 32 


bra dcont ;and continue with common coda 


164S 








1646 


FB1C 


DA 42 


flgset: orab Rag3 ;"0R* in Rag biu 


1647 


FB1E 


20 02 


bra fcont ;and continue with common coda 


1648 








1649 


FB20 


94 42 


ftgclr: anda Rag3 ; "AND" in Flag bita 


1650 


F322 


D7 42 


fcont: stab Rag3 ;sturt 'em back 


1651 


FB24 


20 28 


bra dcont ; and continua with common coda 


1652 








1653 


FB26 




rata pi: 


1654 


FB26 


81 F0 


cmpi #$F0 ;speciaU? 


1655 


FB28 


25 37 


bio domot ;nope, standard motor 


1656 








1657 


FB2A 


81 F8 


cmpa #*F8 ;sube? with whata la ft 


1659 


FB2C 


24 2S 


bha doauba ;yaa 


1659 








1660 






;f all into. domoda ;$F0-IF7 


1661 






braat Reg2,FFLG. domoda ;forcing a rule? 


1662 


FB2E 


12 41 20 AO brset flog2.MFLG.nomc ;no mod* change allowed 


1663 








1664 


FB32 




domoda: 


1665 






(daa #'m' 


1666 






bar dbg ;m 


1667 






.-change moda table, called by LOCMOO elto (meybe) 


1668 


FB32 


80 FO 


suba #$FO ; subtract baaa 


1669 


FB34 


81 F8 OA 


cmpa NUMMOO .-limit ml 


1670 


FB37 


24 9A 


bha mth ; some thing wrong, over table so don't change yet 


1671 








1672 


FB39 


97 18 


sta Curmod .update moda prompt 


1673 






;ldd... Waa 1.x ;gat 1st ruia in new moda 


1674 


FB38 


07 20 


stab Scnrul ; 1 at rule in new moda will ba forcad latar 


1675 








1676 


FB30 


F6 FB OB 


Idab BFCNT ;gat bit field count 


1677 


FB40 


30 


mui ;moda $ 9 tiza/mode in bytoa 


1678 








1679 


FB41 


C3 F8 16 


addd fMOOEOO ;add in baaa of let table in EE 


1680 


FB44 


8F 


xgdx ;swep to X 


1681 








1682 






;Not super fact, but smaller ?? than a 100 O.y, STD 0,x twice? NOPE 1 1 va 8 


1 aai 
1683 






;it IS universal for aiza changes though. 


1884 






tdy fCurmbf ;2 dest, ecuve rules in ram 


1685 






Idab BFCNT ;3 $ to xfar 


1686 








1687 






;wa don't have to worry about ints here since SR.G should atop recursion 


1688 






jar COPYM ;3 copy to ram (domoda) 


1689 


FB45 


BO FC 78 


jsr copybf r.save redundant loada by jumping into COPYR 


1690 


FB48 


7E FA 4E 


jmp FORCER ;3 make it fire 


1691 








1692 






LOO 0.x n gat data (8) 


1693 






5T0 Curmbf ;2 put data 


1694 






LOO 1.x ; 2 2nd word 
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w 



75 



20 



30 









1 696 






] 597 






1 698 






1 699 






1700 


FB4B 




1 701 






1 702 


FB4B 


F7 10 04 


1 /UJ 


FRAP 


7C 00 IB 








1 "f AC 


CQC 1 




1 706 






1 707 






1 708 






1 709 


P8S3 


1 O 


1710 






1711 






1712 






1713 


PB54 


r*n en 


1 / 1 a 


CDC It 




1715 


P857 




1/10 


co«;7 
rt33 / 


CP Pa ap 

ro "w 


1 / 1 / 


caff a 

PD3A 




1 "71 A 
1 / IB 




EE 00 


1714 


rS3U 


AD 00 


1 7?0 
1 / £w 


roar 




1 / i I 


20 02 


1797 






1 771 


FB61 




1 724. 


FB61 


80 13 


1 775 






1 726 


pg 5 3 




1 727 


FB63 


CE F8 10 


1 728 


FB66 


80 1A 


1 729 






1730 


FB68 


24 0B 


1 731 






1732 


FB6A 


DE 1A 


1733 


FB6C 


EC 01 


1734 


FB6E 


2A 03 


1735 






1736 






1737 


FB70 


00 IE 


1738 


FB72 


39 


1739 


FB73 




1740 


FB73 


00 1C 


1741 






1742 






1743 






1744 






1745 


FB75 


39 


1746 







STO Curmbf + 2 ;2 put 



.Digital output only possible in single chip mode (supposedly) 

.although we could use unused port A bits 

digou: 

Idea 1 .x ;get output pattern 

stab DIGOUT .output pattern to defined port 
dconr. inc Outadr ♦ 1 ,-point to real output for gtimar 
;^)@ bug if rollover occurs irOow addreaa byte it >256 EE for rulea 

bra gtimar ;digo 



dosuba: ;coll a subroutina & satup timar 

tab ;mova value to useful place 

Idaa #V 

bar dbg ;s 

subb #iF8 .subtract baaa 

aalb : * 2 f or addresses 

Idx #SU8ADR ;gat the baaa 

abx jndex in 

Idx 0.x ;get tha address into X 

jar 0.x ;calt it 

standard finieh 



domot: 

bar LD_MOT0R ;stuff timar 
; than fall into gtimar 



25 

1725 ; than rail into gtxr 

1728 FB63 gtimar: 

Idx f RULT1M .-timer bit ftaWe 

bar Bf SCN ;check timar bitfields 

bec ?timdn ;no timer for this ruia. 

;C unchanged with DEC A in BFSCN 
Idx Outadr ;recovar pointer to output value 

tdd 1 ,x ;Qat rule f & timer 

bp! 7aenm .positive rule forced timer 

end a #$7F ;maek off high bit 

35 1737 pB70 00 IE atd Inhrul ;neg rule $. inhibit timer 

rta 

?settm: 

std Frcrul ;savo hare for timmt 

Idaa rt ;dbg 

40 1 743 jmp dbg 

?timdn: rta .done for now 
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1747 
1748 
1749 
1750 
1751 
1752 
1753 
1754 
1755 

1759 FB76 

1757 

1753 

1759 FB76 
1760 

1761 FB76 40 

1762 FB77 27 03 

1763 FB79 B8 F8 04 
1764 

1765 

1766 FB7C C8 14 

1767 FB7E 30 

1768 FB7F 00 70 

1769 FB31 39 
1770 



loe motor: lock motor in safe portion 



;used by EEUDATE 
;get safe postton from EE 



;loc motor: 

Idaa MSAFE 
fall into LO.MOTOR 

ID MOTOR. Scale motor value in I! All to 16 bit timer vaiua Mtima 



LD_MOTOR: 

cmpa Latmot 
beq Idr 



;check previous setting (Laat Motor Time) 
;skip computes if same (for speed) 



staa Istmot ;savo motor time for next time in 

tate ;;s«t CCa 

beq zero ;no bias since zero requested 
adds MBIAS ;add in biaa from EE 

;@@@ should be EE? so dynamic scaling possible 

zero: Web IMDEG ;degrees •> time 
mul _; compute it 

std Mtime ;and stuff here for output ints 

Idr: rts 



1771 






.» • • • 




1772 






; BFSCN. checks a bit held for a 1 at the rule 9 in B 


1773 






; and returns Carry Set if high 


1774 






; X points to BF. uses Senrul for rule to check 


1775 






; BFSCNB. B contama rule # being checked 


1776 






; Alters A 




1777 


FB82 




BFSCN: 




1778 






pshb 


;save 


1779 


FB82 


D6 20 




Id ab Senrul ;rule being checked 


1780 






; BFSCNB: 




1781 


PB84 


17 


tba 


.copy 


1782 


FB85 


54 


Isrb 


nnto byte offset, no sign extension 


1783 


FB88 


54 


Isrb 




1784 


FB87 


54 


Isrb 




1785 










1786 


FB88 


3A 




abx ;index into bit field list 


1787 


FB89 


E6 0O 




Ideb 0.x ;get bits 


1788 


FB8B 


84 07 




a ode #$7 .-mask A to bit $ in byte 


1789 










1790 


FB80 


58 


sMb: 


Islb nnto carry 


1791 


FB8E 


4A 




deca ;count down. C unaffected 


1792 


FB8F 


2CFC 




bge shlb Mntif done 8 times 


1793 










1794 






pulb 


;recover 


1795 


FB91 


39 


ru 


;return with Carry eet/dr from ehoae 


1796 






.page 
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1797 
1798 
1799 
1800 



FB92 



••• DVT coda 

F1FO<16),A/D<8},DVT{8). Ftfo runs toward lower addresses. 
0 $8 $10 $18 
OERIVE: 



1801 




; 


bar fclr ;dbg flog 




1802 










1803 


FB92 


37 


pshb ;sava B 




1804 


FB93 


CE 00 50 


Idx #Rfo &ese 




1805 


FB96 


C4 07 


andb #$7 


;maek to channels only 


1806 


FB98 


3A 


ebx 


.•offset to channel § 


1807 










1808 


FB99 


A6 08 


Idea $8,x 


;getfO) -previous 


1809 


FB9B 


C8 04 


Idab #4 




1810 


FB9D 


30 


mul 


;4M(l) 


1811 


FB9E 


00 49 


atd Otemp 


;seve for later uae 


1812 










1813 


FBAO 


A6 10 


Idea $10,x 




1814 


FBA2 


C6 03 


Idab #3 




1815 


FBA4 


3D 


mul 


;3M(0> 


181ft 










1817 


FBA5 


93 49 


aubd Otemp 


;3M(0M # F(1) 


1818 


FBA7 


DO 49 


atd Otemp 


;save again 


1819 










1820 


FBA9 


E5 0O 


Woto $0.x 


M2) 


1821 


FBAB 


4F 


cJra 


;high order dear 


1822 


FBAC 


03 49 


addd Dtemp 


:3M(0M»F(1)*f(2) 



1823 
1824 
1825 
1828 
1827 
1828 
1829 
1830 
1831 
1832 
1333 
1834 
1835 
1836 
1837 
1838 
1839 
1840 
1841 
1842 
1843 
1844 
1845 
1846 
1847 
1848 
1849 
1850 
1851 
18S2 
1853 



FBAE 
FBAF 



AO 

27 OE 



FBB1 2B04 



FBB3 
FB85 

FB87 
FBB9 



FBBD 

FBBF 
FBCO 



C6 7F 
20 OA 

91 F* 

27 04 

ca so 

20 02 

47 
56 



;by way of explanation for the following coda 




;0EC1 HEX 




;385 0181 after ASR shift values 




;129 0081 




;128 0080 if msbyte is 2ero before sNft then data 


win be ok, alsa pmax 


;127 007F 




&o\ 0OO1 




,-000 0000 




;-01 fftf 




;-127 ff81 




;-128 ff80 




:-1 29 ff7f if msbyte ia Ff before shift then data wit 


1 be ok, alee nmax 


;-385 fe7f 




tata ;eheckhigh< 


Kder info 


beq ?bok ;prus normal, 


txit ok 



on* ?ftst ;check negative 

.-positive limit 



?ftat: 



7bok: 



Idab #127 
bra ?sdvt 

cmpa #$FF 
beq ?bok 

Idab #-128 
bra ?advt 

U2 



;other limit 

;neg normal, exit ok 

;neg limit 
i it 



;the long way since no ASRO instruction 



50 



1854 FBC1 E7 18 

1855 FBC3 33 
1856 

1857 FBC4 
55 1858 FBC4 39 

1859 
1860 
1861 



?*dvt: stab $18.x 
pulb 

bsr fset ;dear debug Hag 
rts 



;store hara. DVT data above FIFO & A/0 data 
;rscover channels 



.all dona 



;18 bytes* 
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10 



15 



20 



25 



30 



35 



40 



45 



1882 
1863 
1864 
1865 
1866 
1867 
1868 
1869 
1870 
1871 
1872 
1873 
1874 
1875 
1876 
1877 
1878 
1879 
1880 
1881 
1882 
1883 
1884 
1885 
1886 
1887 
1888 
1889 
1890 

1891 

1892 

1893 

1894 

1895 

1896 

1897 

1898 

1399 

1900 

1901 

1902 

1903 

1904 

1905 

1906 

1907 

1908 

1909 

1910 

1911 

1912 

1913 

1914 

1915 

1916 

1917 



; • • • • Sigrvon meaaage 

.SIGNON: db CR.LF."03/28/91 V - ♦ $80 



isoy hello 



FBC5 CE 10 00 

FBC3 36 92 

FBCA A7 39 

FBCC 8F35 

FBCE 6F 24 



FBOO 4F 

FB01 5F 

FBD2 00 44 

FB04 20 OC 



MAIN PROGRAM 



FB06 30 

FB07 OF 44 

FB09 18CE0O> 

FBOO C6 10 

FBDF BDFC7D 



FBE2 
FB£2 OF 
FBE3 8E00FF 



.certain OPTION. INIT & TMSK2 bits can only be written oncel 
;up to 64 E cydea after reaet. so we MUST configure 
;hera immediately after power-up or COP reaet. 
START: ;once only at power up 

tdx # REG .register bate 

Idea #$01 ;Rem @ $0. Reg <3> $1000 

; ataa $ 1030 ;INIT <5> reaet. But RESET put it thia way ANYWAY 

Idea * $92 .for options... 

;ADPU-1 -onCSEL-O-E IRQE-0-Lv4 DLY - 1 -D CME -0 -off x -0 CR - 1 1 -cop-. 26 Sec 
staa JDPT10N.X ;maki any c hang at now J 

tdaa #$00 ;Bloek Protect off for now 

staa BPROT 

dr_BPROT,X 

Idea #$00 ;timer base rate .SuSee $ 2Mhx. all inta off 

ataa TMSK2 ;»at rata nowl 

dr JTMSK2.X 

;This reeily should bo done by EVM board aince a change to CONFIG reauiree 

that ALL EEprom in -A1 be areaad (Bulk ia only way to eraae cpnftg) 

High 4 bita determin EEPROM location in -A2 chip (2k on upper 1 12 of 4k bound 

if I expanded, eiee $F800 if single chip mode. 

EE overlays ROM in -A2 Single chip therefore no Buffalo routinee ecceaal 

tdaa #$H) ; $c for EE in • A2, noeee • 1 nocop - 1 romon-0 aeon - 1 

ataa CONFIG ;aet configl But sines EE cell don't neve to. 

ifdef ILLSUG ;doing debug on illegal instructions trape 
^jeuaily causa by bad rule atructuraa 

Idd 10000 
cira 

drb :the small way to gat 0 -0 

atd Mabb :p re vent trash first Time around 

bra BEGIN ;skip thia next bit 

wa end up hare on an illegal instruction or SW1 trap 

(START: tax ;gat old stack for illegal instruction trap 

stx Msbb ;save for output later 

kty ftNBUFSTA ;desi 
(dab #16 ;this many 

jar COPYM ;copied (istert) & PRAY atack ia OKI77 



andif 



normal restart of program f R> 



BEGIN: 



ids rros 



off int'i if on 

;lood stack at top of ra 



50 
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70 



75 



20 



25 



30 



35 



1918 


FBEfl 


80 40 




bsr INITS 


.'initialize sub-systems 


1919 












1 920 


FBE8 


OE 




eli ;ciear int 


mask. Int' a eneblod Qlobelly 








;<e><?@ a 


nd other stuff yet 




1922 












1 923 






;• signon 




1 924 








Idx ISIGNON Say hello 


1 925 








jsr PMSG 




1926 






;SIGN0N ten is only version number sines we've run out of specs 


1927 








Idea #VER ;current version 


1 929 








jsr HOUTS .'output 




1 929 












1930 


FBE9 


CE F8 00 




Idx #0ATE 


;Rule date in EE 


1931 


FBEC 


C6 03 




idab #3 


;thie many 


1932 


FBEE 


BO FE 88 




jar PHMSG 


.saved in hex 


1933 












1934 








ifdaf ILLBUG 




1935 


FBF1 


OF. 44 




Idx Mabb 


;croshed? 


1939 


FBF3 


27 00 




beq 7ncrsh 


;no 


1937 












1939 


FBF5 


96 20 




Idea Scnrul 


;ieat scanned rule 


1 939 


FBF7 


or\ ce a c 




jsr HOUTS 


;inform 


1940 












1 941 


FBFA 


C6 10 




Idab #16 .this many out 


1 942 


FBFC 


CE Ov AA 




Idx ftN.BUFSTA 


;from herel 


1 943 


CQCt 

rorr 


on cc aa 
BU ht 99 




jsr PHMSG 


; inform user 


1 944 


FC02 




?ncreh: 






1 945 








endif 




1 946 












1 5je/ 






; • power on start command 




1 9+9 








Idea Istcmd ,1aat ante 


red command saved in eeprom 


1 3*Jf 








tdae rv .starting cmd 




1 O C/t 








jsr OUT_QC ;echo 




1 ad 

1 93 1 












1 OC3 








bra TSTCMO .fake it 




i jjj 












1 954 












1955 






;MAIN program command loop 




1 956 












1957 


FC02 


B0 FE 60 




Ipin: jar (prompt 


;new fine & rule # on screen 


1958 


FC05 


1 2 41 08 F9 




Ipin: braet flagi.CFLGJ 


pin ;Rule changed? print 


1959 












1960 








wei ;Wait for 


any interrupt (SCI deetred) 


1961 


FC09 


BOflF 21 




jar tN_DQ 


;Get char? 


1962 












1963 


FCOC 


25 F7 




bes Ipin ;Watt until we have one 


1964 












1965 


FCOE 


13 40 40 09 


brdf Ragl.EFLG.n 


echo ;Echo? none if dr 


1966 












1967 


FC12 


81 00 




cmpe #CR 




1968 


FC14 


26 02 




bne echo 




1969 












1970 


FC16 


20 EA 




bra Ipin ;crif & prompt 


1971 












1972 


FC18 


30 FE 3E 




echo: jsr OUTJX 


;Echo it 


1973 










1974 


FC1B 




nocho: 







50 



55 



48 



4SDOC10: <EP 0S48855A2_L> 



EP 0 549 855 A2 



1975 


Fcia 




TSTCMO: 




1978 


FC1B 


CE F9 00 


Pcmds: 


Idx ffCMDTBL ;Use this table 


1977 


PCI E 


8D F9 32 




jsr CMODISP .CoMmanO DlS Patch 


1978 


FC21 


25 02 




bee ?err3 ;Command not found 


1979 










1980 


FC23 


20 00 




bra Ipin ;Get next command 


1981 










1982 


FC25 


86 21 


?err3: 


Idaa #T ;Bad command response 


1983 


FC27 


BD FE 3E 




jsr OUT_QC ;Send it 


1984 


FC2A 


80 FE 3E 




jsr 0UTJ1C ;Twice 


1985 










1986 


FC20 


06 A4 


?ewt: 


Idab Qutjjffil .Has avar/tWng bean printed? 


1987 


FC2F 


26 FC 




bne ?ewt ;Hang around until it ia 


1988 










1989 


FC31 


20 CF 




bra Ipin £tart over 


1990 










1991 


FC33 


OC 


NULL: 


etc ;atop errors 


1992 


FC34 


39 




rta ,-Null cmd input characters jsr to here 


1993 








1994 






.page 





20 . 
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70 



75 



20 



25 



30 



35 



1 995 






1 396 






1 997 






1998 






1999 






2000 






2001 






2002 






3ftft"* 






2004 


FC35 


rr 4ft ftft 




tan 






FC3A 




ivy / 


PC3A 


00 42 










FC3C 


CC 00 40 


2010 


FC3F 


00 48 


1 1 
1 1 






?fti ^ 


FC41 


F6 F8 05 




FC44 


07 40 


201 4 






«U 1 9 


FC46 


80 41 


7ft 1 8 

4U 1 © 






3ft 1 7 


101] 


201 8 






20 1 9 


iooi 


2020 






2021 






2022 






2023 






2024 






2025 






2028 






2027 






2028 






2029 






2030 


FC48 


4F 


2031 


FC49 


5F 


2032 


FC4A 


00 10 


2033 


FC4C 


00 70 


2034 


FC4€ 


00 16 


2035 






2036 






2037 






2038 


FCS0 


5A 


2039 


FC51 


00 18 


2040 






2041 






2042 


FC53 


CC 01 01 


2043 


FC56 


00 1C 


2044 






2045 






2046 


FC58 


00 3D 


2047 






2048 


FCSA 


CE 10 00 


2049 






2050 






2051 







; • • • • subsystem initialize • * # * 
JNITS: 

could do this with a LOO. S00 if space gets tight 
Idea #EFLG ; start with... 

;no XOFrfl, ECHO no HEX INPUT 

staa Ragl ; stuff it 



Idaa #0 



; nothing hare for now 



Rag2 




Idd #«EFLG>* 


258*0) ;combined. Ragl • 256 + Rag2 


std Reg1 


; stuffed here 


std Rag3 


;rule Regs3 starts out CLEAR <Flag4 tool 


)dd #Tmot 


; dummy address initially 


etd Adjadr 


;stuffed here for tune 


Ideb MSAFE 


;an initial pulse width from EE 


stab Tmot 


;to protect motor. 


bar SCUNI 


;starup set, X will point to REG base on exit 



;?np: 



ifndsf CHIP A 2 
jsr ERUOATE 
endif 

Idx #FHblk 
Idd #$0010 
sta 0.x 



.Update EE if required 



.block to fill 
;RII block, length 
.stuff fill value 

;count down 



decb 

bne ?flp .-until done (256 max) 

; 1 2 bytes 

Idd #0000 ;2ero 

cira ;Zaros 

clrb ;the small way to get 0*0 

std Srcadr ;so no errors on startup 

std Mtime ;no pulses at start 

std Stime ;no stop time 

;# std Btime ;no falsa beeper 



;® maybe Currui- 5FF batter? 

dscb 

std Curmod 



;turn into nils into IFF 

;start with MO 0600 (A) & this rule (BJ on power up 



;t this is where the startup rule is fired 

Idd #90101 ;force rula 1 on 1st timint (##tt) 

std Frcrul ;by stuffing here 

Idd #$0001 "# no repeat, .2 beep on reeat 

std Btime ;# beep .2 sac on startup 

Idx #REG ;get base again (EEUOATE may corrupt) 

Idaa #$00 ;set all bits ae input 

Idaa #$FF ;sat all bits as output for now (no pullupe) 

staa OORC ;0ata OiR C 
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2052 


FC50 


6F 07 


cir _0DRC,X ;a« inputs on C 


20S3 








2054 


FC5F 


86 83 


Idas #583 :PA1 is out. RTInt <§> 32.77mS if enabled 


2055 


FC61 


A7 26 


staa J>ACTL.X xonfig A ports bit & Real Time lot rata 


2056 








2057 




: spitm: 


2058 


FC63 


CS FF 


Idab #SFF ;near1y all bits output CSS is gan purpose out! 


2059 


FC65 


€7 09 


stab _0DRD,X ;sac port 0 direction 


2060 








2061 


FC67 


C8 51 


Idab >%01010001 ,-SF11SPe.DPSH/PULMSTR CPOLH.CPHAO.SFH1&0 


2062 


FC69 


E7. 28 


stab _SPCR.X ;EnabJe SP1 as Master @ E/4 baud 


2063 








2064 






Idab _SPSR.X ;Fake a read to dear SPtF flag 


2065 






Idab _SP0R.X ;so writes possible 


2066 








2067 








2068 






startup timer OC1 


2069 






we won't do thus hare since we don't want a restart to bo visible, eh 7 


2070 






1 st 0C1 int 32msec sftar power up?? 


2071 






Idd TCNT ; currently 


2072 






addd #RTCRAT ;some time from now 


2073 






. std T0C1 .setup 


2074 








2075 


FC6B 


86 80 


Idas #180 ;OC1 bit 


2076 






staa.OCIM.X .let OC1 affect 0C1 bit 


2077 






staa _0C1D.X :sat 0C1 high on compares, others low 


2078 






dona earlier staa _PACTL.X ; enable output dnver OC1 


2079 


FC6D 


A7 22 


staa JTMSK1 .X ; enable OC1 timer inta U80) 


2080 








2081 




; @(tp@ this should be under interrupt (and maybe power down if stow enough) 


2082 






Start A/0 scanning/converting 


2083 


FC6F 


86 30 


Idas #$3a :CCF/x/scan/mult chO-A :scan 0-4 repeatedly 


2084 






Idas 1*10 :scan 0-4 once 


2085 


FC71 


A7 30 


staa JV0CTL.X .start A/D 


2086 








2087 






• • • • COPYR copies MODEOO to ram 


2088 


FC73 


CE FB 16 


COPYR: Idx #M0DE0O ;src here 


2089 


FC76 


18 CE 00 12 


copybf: Idy ICurmbf ;dest hare 


2090 


FC7A 


F6 F8 08 


idab BFCNT .bit field size 


2091 




;fall into 


2092 






• • • • 


2093 






COPYM. X points to Src, Y to Oast. 3 is size. Coiled everywhere 


2094 






. • • • • 


2095 


PC70 


A6 00 


COPYM: Idas 0.x ;get data 


2096 


FC7F 


18 A7 00 


staa O.y :stuft hero 


2097 


FC82 


oa 


inx ;bump up pointers 


2098 


FC83 


ia oa 


iny 


2099 


FC85 


5A 


decb ; count down 


2100 


FC86 


2EF5 


bgt COPYM .until dona 


2101 








2102 


FC88 


39 


rts 


2103 






; • • • • end of inits 


2104 








2105 






. # • • ♦ 


2106 






;SCIINI. Initialize HOPTR. TLPTR, BFSlZ . BAUD. SCCR's 


2107 








2108 






.could use copym but only one byte saved 18L vs 17M 
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SCIINI: Wd #1NBUFSTA ;init hdptrs & dptrs to start of buffers 
std In^hdptr 
std ln_tfptr 

tdd f OUT_BFSTA 
std Out_hdptr 
std Out Jiptr 

Idd #0000 :buff ers start out empty 

cifa .buffers start out empty 

1llo c r *n «P clrb ;tha small way to gat 0-0 

10 VM £11 Li stdOutJ)ffil ; which daaraln^ffilin following byta too 

; Initialize SCI registers 

Idx #REG register baea 

: Idea #$00 ;l/8/l bits. Idle line wakes revr 

: staaSCCm 
75 t't* aor clr.SCCRI.X ;satup 

;EH byte for baud rata 
ifndef CHIPA2 

kJaa IFB03 ;from hera 

*> VM cr.n p fiPfl03 ; ^ Id- BORATE ;s30«E/13/1 >9600 $34-E/13/1 6>600 baud 

endrf 

staa BAUD 

staa _BAU0.X 

25 I] \* SCIIEN: ;EEUD ATE/SAVE returns here to restart Rxint'e 

Idx #REG ;basa again becausa of EE 16 v» 8) 

beat _SCCR2,X,$2C ;Rcvrlnt£,TxEn.RxEn 
rts 

j • • • • end of sciini 

2143 

30 



2109 


FC89 


CC 00 AA 


2110 


FC8C 


00 A6 


2111 


FC8E 


DO A8 


2112 






2113 


FC90 


CC 00 80 


2114 


FC93 


DO AO 


2115 


FC95 


00 A2 


2116 






2117 






2118 


FC97 


4F 


2119 


FC98 


5F 


2120 


FC99 


DO A4 


2121 






2122 






2123 


FC9B 


CE 10 00 


2124 






2125 






2126 


FC9E 


6F 2C 


2127 






2128 






2129 






2130 






2131 






2132 


FCAO 


B6 F8 03 


2133 






2134 






2135 






2136 


FCA3 


A7 2B 


2137 






2138 






2139 


FCA5 


CE 10 00 


2140 


FCA8 


1C2D 2C 


2141 


FCAB 


39 


2142 






2143 
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2144 






. • • • • 






2145 






; EE UpOATEs only changed bytes sines faster than whole rewrite 


2146 






; Copies e piece of code to RAM at IN_BUFSTA since EE disappeers on EELAT 


2147 






. • • • • 






2148 






;@@@ we now only update a smell block et a time 


2149 






;svmsg: db " 


avin # /g - + $80 




2150 












2151 






SAVE! 


udates EE 




2152 


FCAC 




SAVE: 






21 S3 






bsr EEUDATE .-called at command level now 


2154 






bra SCIIEN ;restart Rxints 


2155 


FCAC 




EEUOATE: 






2156 






; Idx fsvmsg ;inform 




21 57 






; jsrPMSG ;user 




21 58 


















;@<§> we should be so fast that no one notices 10msec hick-tip 


21 60 






; sei 


;iurn off ints & pray for no COP, XIRQ 


21 61 












21 62 






;<§> stricrJy speakinQ RXint ONLY needs to be off at this point. Leter ALL off. 


21 63 


FCAC 


CE 10 2D 




Idx #SCCR2 


.-register to mess with 




eric 


10 00 20 




bdr 0.x. $20 


;kill rxint enable (6 bytes) 


21 65 










21 66 


PC82 


CE FD 00 




Idx fpbee 


;arc 


2167 


FCB5 


18 CE 00 AA 


Idy #IN_BUFSTA 


;dat. since usually empty 


2168 


FC89 


C6 10 




Idab #<pbeee-pbeej 


I ;fength less than 2561 (1 6 actually) 


2169 










2170 


FC8B 


BO FC 7D 




Jsr COPYM 


;copy EE subroutine to ram 


2171 










2172 


FCBE 


DE 10 




Idx Srcadr 


;current source in ram (EE write edr) 


2173 






beq 


pbret .-nothing to save, AN ERROR 


2174 


FCCO 


ac F8 00 




cpx f EE 


;where EE sits 


2175 


FCC3 


25 31 




bio pbret .not EE. skip itt 


2176 












2177 


FCC5 


18 CE 00 00 


WyfWrxrul 


;ram table 


2178 


FCC9 


ca io 




Idab #RStZ 


;ts this big 


2179 


FCCB 


18 A6 00 


pcomp: Idea 0,y ;gat current ram data 


2180 


FCCE 


Al 00 




cmpa 0.x 


.-compare with previous saved EE 


2181 


FCOO 


27 1E 




boq bdec 


;same so skip pgmtng this byte 


2182 










2183 


FCD2 


37 




pshb 


;save counter 


2184 


FC03 


18 3C 




pshy 


;sava current pointer 


2185 






;dbg. M 




2186 


FCOS 


36 




psha 


;save data 


2187 


FC06 


BOFE A8 




jsr HOUTC2 


;dbg 


2188 










2189 


FC09 


32 




puis 


;get back 


2190 


FCOA 


36 




psha 


.save again 


2191 


FC08 


BOFE Af 




jar HOUTS 


;dbg 


2192 










2193 


FCDE 


32 




puis 


;get data back 


2194 












2195 


FCOF 


C6 16 




Idab #$16 


;byte erase first 


2196 


FCE1 


80 15 




bsr pba 


;do it 


2197 










2198 


FCE3 


OE 


cli 


; allow an int (but no rxint) since rules still in Ram 


2199 


FCE4 


81 FF 




cmpa #$FF 


;did we only need en erase? 


2200 


FCE6 


27 04 




beq ffdone 


;yes 
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2201 








2202 


FCE8 


CO U2 


Idab f$2 :program 


2203 


FCEA 


9U VKm 


bsr pba ;now 


2204 






ffdone* cii .allow a few mora ints 


2205 


FCEC 


OE 




FCED 


13 38 


puly .recover am 


2207 


FCEF 


33 


putb 


2203 






_ _ . ,_ — hufne aointara ahosd 


2209 


FCFO 


08 


2210 


FCF1 


1808 


«ny 


22U 


FCF3 


5A 


dacb ,*and count down 


2212 


FCF4 


26 05 


Dna pcomo ,unui tore 


2213 








2214 


FCF6 




pbret: 


2215 


FCF6 


20 AO 


bra SCtlEN .'restart Rxinta 


2216 






rtj ."done update 


2217 








2218 


101! 


.u.i mPOM tonv anabled 


2219 






, copsot rsiais ma wur unw 


2220 






• COPSaC' IQaO #*O0 iV»U" auanuun 


2221 








2222 






comb ."ft'P 't co SAA. ona byte ahortar 


2223 






jtebCOPRST 


2224 






rts 


2225 








2225 






; • • " • coda compreeeion aubr 


2227 






pba: bar copaet ;reset cop 


2228 








2229 


1011 


also 


2230 


FCF8 




pba: 


2231 


1001 


endif 


2232 








2233 


FCF8 


1 8 CE 08 98 Wv #2200 ;2500 - 10 maec<& 4cy«ey 3333 - 10maec<3>3/dex 


2234 


FCFC 


OF 


$« ,»top ALL inta a* pray no XIRQ 


2235 






imp pbee ;program byta/arasa & rat 


2236 


FCFO, 


7E 00 AA 


jmp IN_BUFSTA ;its reoUy hera 


2237 






; • • *tha following 1 6 bytaa gat copiad to rem ao EEUOATE can call with 


2238 






2239 






:B »at to erase or pgm cmd, Y with dalay value, and X pointing to addreas. 


2240 






;A with vaiua to pgm 


t* 4 * » 


FDOO 




pbaa: 


2242 


FDOO 


F7 10 3B 


aiab PPROG ;aat EELAT 


2243 


F003 


A7 00 


staa 0.x ;wnte or eraee Q x 


2244 


FOOS 


7C 10 38 


incPPROG ;EEPGMup 


2245 


F008 


18 09 


wtIO: day .count down 


2246 


FOOA 


26 FC 


bna wt10 .until dona 


2247 


FOOC 


7F 10 38 


clr PPROG ;finiahad 


2248 


FOOF 


39 


rts : return to EE coda 


2249 


F010 


pbaaa tqu $ ;end of part copiad to ram. 1 6 bytee 


2250 






; nd of EEUOATE 


2251 






.page 
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2252 










2253 






; ENTER; Fiddles memory locations. Operates directly if ADOR < 58000 


2254 






: AOJUSTJ Adjust values of rule table. Asks for rule #. copies to ram if not 


2255 






; already there, and then asks for parameter to change. 


2256 






;<3 have fun... 




2257 










2258 






;ovmsg: db "nter \"<5>" - S80 




2259 






.rnmsg: db-djV#'<>s80 




2260 


FD10 


00 OA C5 


eimsg: db CR.LF.'E' <- $80 ;"E!em".-#- ♦ 380 


2261 






;nvmsg: db *NeV w" * 580 




2262 






. • • • • 




2263 


FD13 




update: 




2264 


F013 


9C 10 


cpx Srcadr 


;ssme ss current request in X7 


2265 


F015 


27 00 


beq ?endud 


;yes. no RAM update required 


2266 










2267 






;(§> do we want to prompt for save? Oo we want a reread? 


2268 






; isr EEUDATE different, need to update EE before overwrite 


2269 


F017 








2270 


FD17 


DE 44 


idx Msbb 


recover requested source address 


2271 


FD19 


OF 10 


stx Srcedr 


.new set will be from here 


2272 


F018 


18 CE 00 00 


Idy #Wrkrul 


destination is.. 


2273 


FD1F 


C6 10 


Idab 4RSIZ 


;this big 


2274 


FD21 


80 PC 70 


jsr COPYM 


;copy new set to ram 


2275 










2276 


F024 


DE 10 


7ondud: Idx Srcadr 


;get it again (unfortunately) 


2277 


FD26 


OF 25 


stx Offadr 


;fix offset for prim outs 


2278 


FD28 


CE 00 00 


Idx fWrkrul 


;this is where data now (or still) sits 


2279 


FD29 


OF 4B 


stx Adjadr 


;setup work pointer 


2280 


F020 


39 


rts 




2281 










2282 






; • * • • ENTER | ;uses absolute address, no rule fiddling 


2283 


FD2E 




ENTER: 




2284 






Idx fevmeg ; enter value message 


2285 






; bsr GETNUM .input an 


address. Returns to main if nothing entered 


2286 


FD2E 


80 67 


bsr GETVAL 


;get a value. Return to main if none. 


2287 










2288 


FD30 


CE 01 10 


Idx #90110 


;heedor 1 line, 1 6 elements 


2289 


FD33 


SO FE 06 


jsr ENTDMP 


;do heeder & data @ Msbb 


2290 










2291 


FD36 


4F 


clra ;zero 




2292 


F037 


SF 


clrb .the small way to get D»0 


2293 


FD38 


00 25 


std Offadr 


.assume direct eddr. Clear offset 


2294 










2295 


FD3A 


OE 44 


Idx Msbb 


;get the address to fiddle 


2296 


FD3C 


a/* n/> 

8C Bo 00 


cpx #38600 


;iower limit of EE 


2297 


FD3F 


25 2E 


bio fuiedr 


;no EE udate, use it diroctiy- 


2298 










2299 


F041 


80 00 


bsr update 


.update EE if different from current 


2300 










2301 


FD43. 


20 2A 


bra fuladr 


;to common code 


2302 










2303 






ADJUST; twiddle rules, fnendlier user interface 


2304 


F045 




ADJUST: 




2305 






Idx Jrnrnsg ;ruie # mag 


2306 






bsr GETNUM .input rule #. Returns to main if nothing entered 


2307 


F045 


80 50 


bar GETVAL 


;get a value. Return to main if none. 


2308 
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2309 
2310 
2311 
2312 
2313 
2314 
231S 
2316 
2317 
2318 
2319 
2320 
2321 
2322 
2323 
2324 
2325 
2326 
2327 
2328 

2329 

2330 

2331 

2332 

2333 

2334 

233S 

2336 

2337 

2338 

2339 

2340 

2341 

2342 

2343 

2344 

2345 

2346 

2347 

2348 

2349 

2350 

2351 

2352 

2353 

2354 

2355 

2356 

2357 

2358 

2359 

2360 

2361 

2362 

2363 

2364 



F047 
FD49 
FD4A 



F040 
F04F 

FD51 
F052 
F053 



FD56 
F057 



06 45 
37 

30 FA 3A 



OF 44 
80 C2 

33 
5C 

BO FA 3A 



8F 

93 10 



F0S9 C4 0F 

F05B 26 02 

F050 C6 10 

FOSF 86 01 

FD61 8F 

F062 80 FE CS 



FD65 
F068 



FD6A 
FD6C 
FD6E 
FD6F 



CE FO 10 
80 2A 



DE 48 
06 45 
3A 

80 12 



F071 20 3C 



F073 

F073 BO FF 30 

F076 25 26 

FD78 4F 

F079 5F 

F07A 00 25 

F07C DE 44 

F07E 20 03 

F080 



Wato Lsbb ;get rule 9 tmo 8 

pshb ;seve for 2nd rule difference 

jsr GETEOR ;get rule's address from indexed table (we think) 

be* ?nru* :atreedy in RAM 

stx Adjadr ;save »t here for later use 

stx Msbb stuff for memdmp to use 

bar update ;updeta EE if needed 

?nrul: pulb .-recover ruJe $ 

incb :next rule 0 

jar GETEDR :got next rules 's eddresa 

;bcs not needed here since if rule was in ram. this one wouldn't be 
";and if it wasn't, rule would heve been put there by update 

xgdx .into 0 

subd Srcadr ;find address difference 

bne ?ednz ;addresa difference NOT tero. may be ok 

;if difference «0 then same rule at both locations. Do we get the NEXT one up & 

.try again?? For now. just limit to 16 elements. 

andb #50F ;and B has length (1 6 max) 

bne ?bnz .reesoneWe length? 

(dob #S10 .limit to 16 

?bnz: Idea #1 .'one line of info, b hes length 

xgdx ;swep to X 

jsr ADJOMP ;;let memdump do the work 

Idx feimsg .element $ 

bsr GETNUM ;get info, returns to main if no entry 

Idd Adjadr .recover basic address 

addd Msbb :indude element offset <16bitl 

xgdx .'into x 

;since we can't be more than 1 6 elements offset 

Idx Adjadr :get basic address in RAMI! 

Idsb Lsbb .'include element offset 

abx .'include in X 

fulodr. bsr prnedr ;tell them 

bra tadj ;tune it 

;RTDSPH uaas these. X preset to Adjadr by CMDSPH 
SETAOR: 

jsr HEXJ3IQ :get an address 

bes getret* ;no input, use old value (RTSJ 



drs 

drb 



;the smell way to get 0*0 
std Off adr .clear offsets 



Idx Msbb 
bra prnadr 



;get input value 
;sturf & pnnt 



INCAOR: 
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15 
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2365 
2366 
2367 
2368 
2369 
2370 
2371 
2372 
2373 
2374 
2375 
2375 
2377 
2378 
2379 
2380 
2381 
2382 
2383 
2384 
2385 
2386 
2387 
2388 
2389 
2390 
2391 
2392 



F080 08 
F081 08 
P082 
F082 
FD82 09 



FD83 OF 4B 

F085 3C 

FD86 8F 

F087 03 25 

FD89 8F 

F08A 80 FE A8 

F08D 38 

FD8E BD FE A2 

FD91 7EFF0C 



OECAOR: 



•nx 



dex 



;modify pointer 

.compensate for falling into dex 



.modify pointer 



limn the address to modulo 1 6 

xgdx .swap to 0 for limits 

clra ;htgh order of address < 256 (RAM <§> 0) 

andb *$F .modulo 18. A will be zero 



xgdx 
fell into ... 



;becx to X 



prnadr: stx Adjadr ;save for RTDSPH functions 

p$hx .save Ram address 

;swep into 0 

1 Offadr equivalent address offset (since data's at zero now) 

;back to X 



xgdx 
xgdx 



jsr HOUTC2 



.print it 



pulx .recover ram address 

jsr CRLF ;new line A 



jmp svp 



jprcmpt for adjustments 



;GETNUM. prompts with message @ X & gets a number with echo. Returns to main i 
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2393 
2394 
2395 

2396 F094 80 FE 71 
2397 

2398 F097 80 FF 3D 

2399 

2400 

2401 FD9A . 24 01 
2402 

2403 F09C 38 

2404 FD9D 
2405 
2406 
2407 

2408 FO90 OC 

2409 F09E 39 
2410 

2411 
2412 
2413 
2414 
2415 

2416 F09F 
2417 
2418 
2419 

2420 F09F 14 41 01 



;no entry. 

;GETVAl As above but.no message. 
; Placed here so BSR's in possible 

GETNUM: jsr PMSG .-prompt user 

GETVAL: jsr HEXJ1IQ .get value 

bcs NULL ;no entry, return directly 

bcc 7getok ;no error, normal return 



pulx 



.pop callers address. Returning to MAIN 



?getok: 



Idx Msbb ;get value 

imp H0UT2S ;echo »t 

cic ;make certain no error to MAIN 

getret: rts .also used by SETA OR 



; TUNE | write values to the motor 
;<§> Could we use adjust functions?? 

.tnmsg: db "uneV " * $80 
TUNE: 

Idx ftnmsg 
; jsr PMSG ;tune msg 



bset Rag2.TFLG :stop state diagram, sat tuning flag 
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5 



30 



2421 










2422 


r0A2 


CE FD C7 




id* ftsxit ;tune exit 


2423 


FDA 5 


3C 




p»hx .setup ss return for RTDSPH if ESC entered 


2424 










2425 








Idx 9 Adjadr ;last address adjusted 


2426 








Idea 0.x ;get value 


2427 








staa Tmot ;$ave here 


2428 










2429 


FDA6 


CE 00 40 




Idx jfTmot .address to fiddle 


2430 


F0A9 


OF 4B 




stx Adjadr ;setup for keyboard 


2431 










2432 


FOAB 


4F 




clra 


2433 


FDAC 


5F 




clrb ;the smell way to get 0«0 


2434 


FOAO 


DO 25 




std Offadr :Zero offset for correct print out 


2435 










2436 






;entry here from enter and adjust 


2437 


FOAF 


BO FE A2 




tadj: jsr CRLF ;new line for achos 


2438 


F0B2 


BO FF 21 




?slp: jsr IN_0Q ;got e char 


2439 


FOBS 


25 FB 




bcs ?slp ;none avail, loop here 


2440 










2441 


FDB7 


BO F9 2F 




jsr RTOSPH ;adjust a variable 


2442 


FDBA 


25 F6 




bcs ?slp .not one of ours so loop again 


2443 










2444 


FOBC 


13 41 01 F2 


brclr Flag 2.TFLG.? sip . :not tuning motor, skip motor update code 


2445 










2446 


FDCO 


96 40 




Idaa Tmot .from new temporary value 


2447 


F0C2 


BD FB 76 




jsr LDJvlOTOR ;scale to Mtima 


2448 


F0C5 








2449 


FDC5 


20 EB 




bra 7slp ;and hang around until ESC causes exit 


2450 










2451 






; entered by ate exit's attempt to return to main 


2452 


FDC7 




texit: 




2453 


FDC7 


15 41 01 




bclr Rag2,TFLG ;reenable state machine 


2454 






; adjust' s abort exit too 


2455 


FDCA 




endadj: 




2456 


FDCA 


39 




rts ;return to main 


2457 
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2458 








2459^ 






; Senai communication incorrupt routine 


2^60 








2*61 






Need to enable ints earlier. Clear rxint & txint for each routines section 


2462 






also neeo a QOt cnar luncnon inai ocean i move upnir so calling possioie: 


2463 






;<§> Needs to be sped up. @96COB less than 1 msec/char available, ♦ other ints! 


2464 


FDCB 






246S 


F0C8 


CE 1 0 00 


IHv IRFCI *hasa 


2466 






Idea SCSR ;who interrupted? 


2467 


FDCE 


A6 2E 


Idea SCSR.x /who interrupted? 


2468 


FOOO 


85 20 


hit* -Tx/Te/Rdrf/ldl Or/Nf/Fa/X 


2469 


FDD2 


27 36 


boo, trantst /is NOT the receiver, maybe tx 


2470 








2471 






lOaa 9LUn >o receiver, so yei cnorocior 


2472 


FD04 


A6 2F 


Idea SCOR.x ;IS receiver, so get character 


2473 


F006 


84 7F 


and a #S7f ;ctaar parity 


2474 






cmpa #X0FF ;is it XOFF? 


2475 


FD08 


31 13 


2476 


FDDA 


26 05 


bno ?xont ;nopo 


2477 








2478 


FOOC 


14 40 80 


bset HaQi.ArnrLU) .stop runner ot. AOu raceivefl 


2479 


FOOF 


20 52 


bra no uan ;stop immediately 


2480 








2481 


F0B1 


81 1 1 


'xont: cmpa f xun ..AUiNr 


2482 


FDE3 


26 OB 


bne wtjn ;nope, must EN_Q it 


2483 








2484 


FDE5 


1 5 40 80 


k.i, n M i Y CQC1 • YHKJ l«t r-» no 
OCir rieg i , Arnruvj ,Aun, iat ui go 


2485 


FDE8 






2486 


FDE8 


96 A4 


idee uut DTTii , siuiT avail < uoa snorxer man isn 


2487 


FDEA 


27 3F 


OeC) enoini .no, so nni» noininy to i a now inai wo ro aiiowea 


2488 








2489 


FDEC 


80 41 


h«r rvnn ■ cf • rn i f\ Mr inT4 


2490 


■ 






2491 


FOEE 


20 1 A . 


rr«nrcf ■ arv4 nrocn44 nurviinn int 
QrO irsriiai ,aiiu ^rutaaj ^oiiuiiry ink 


2492 








2493 








2494 






j Queue the character in acca •* ^ input buffer 


2495 






cnanQS to a Dit onsets ror speeu/sizar hda wun o us airsoi 


2496 






. • • • • 


£**9f 






■(Si rhi« i« m TRAP Can't amt characters out since we're huno. wattina 

# \y villa 19 Q 1 n^r • WOi* » V v mui o^* tui J uuv j |m vu ' nwuii^ 








(a) in An tSRIM 




FOFO 


06 AS 


wt in: Idab In brfil ;cjet current size 




rurx 


CI 1 1 


cmpb #IN BFMAX .check for room 










2502 






; • send XOFF if near full 


2503 








2504 






bh* wtjn .we'll have to wait for room 


2505 


FDF4 


22 14 


bhi trantst ; we'll just have to iooae char while we wait for ro< 


2506 






;; could load bfmax into b and loop on cmp bffit for tighter loop 


2507 






:@could also ailow 2 chars more into buffer until xoff takes effect 


2508 








2S09 


FDF6 


3C 


pshx :save rag pointer 


2510 


F0F7 


OE A6 


(dx In^hdptr ;get head pointer 


2511 


FDF9 


A7 00 


staa O.X ;and store char in que 


2512 








2513 


FDFB 


7C 00 AS 


inc Injiffil ;one more in queue, safe from Int's 
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251 4 






251 5 


rOFc 


08 


251 6 


FDFF 


3C 00 BF 


2517 


FE02 


23 03 


251 8 


FE04 


CE 00 A A 


2519 






2520 


FE07 




2521 


FE07 


OF A6 


2522 


FE09 


38 


2523 






252 4 






2525 

i. J A J 






2526 






2527 

444' 












2529 


FEOA 




2530 


FEOA 


A6 2E 


25*11 

40J 1 




2A 1 n 


25^ 2 
43J4 








"Cue 


1 ? Aft QQ 2 1 


2514. 






2535 

43J3 




96 A4 


2536 


FE14 


27 ID 


2537 






2538 


FE1 6 


OE A2 


2539 


FE18 


A6 00 


2540 


FE1 A 


87 10 2F 


2541 


FE10 




2542 


FE10 


08 


2543 


FE1E 


8C 00 9F 


2544 


FE21 


23 03 


2545 






2546 


FE23 


CE 00 80 


2547 






2548 


FE26 




2549 


FE29 


OF A2 


2S50 


FE28 


7A 00 A4 


2551 






2552 






2553 






2554 






2555 






2556 






2557 






2558 


FE2B 


38 


2559 






2560 






2561 


FE2C 


CE 10 00 


2562 


FE2F 


1C2D80 


2563 






2564 


FE32 


39 


2565 






2569 






2567 






2568 






2569 






2570 







;$top pointer ahead 
cpx #IN JFEND ;past and? 
bis tn_norap1 .no, no wrap needed 
Idx fIN SUFSTA ;yes. wrap back to the start of buffer 



♦n_norap 1 : 



stx ln_hdptr ;update hdptr 

pulx recover reg pointer 



;faJl through to.. 



;nont serviced here efter rx does work (also rx bra's if XON/XOFF) 
. • • • • 

trantst: 

Idaa _SCSR.X ;ts it the transmitter? 

bpl endint :no. so we're done poK (TXBE - MSB. high is neg) 

brset Reg l.XFRFLG, notran ;Xoff? Yea. turn off txint for now 



Idaa Out J>ffil 
beq notran 



;ia there anything left to transmit? 
.empty, so skip to end & kill future ints 



Idx Out^tlptr :g«t pointer 

Idaa 0.x .get cher 
staa.SCOR ;send it out 

tnx ;skip to next spot 

cpx #OUT_BFENO ;did we faU off end of buffer? 

bis out_nowrp2 ;no, skip wrap 

Idx I OUT 8FSTA :yes. point back to the start 



out_nowrp2: 



stx Out_tiptr 
dec Out"bffiI 



;update tail pointer 
;one less occupied space 



cmpa #0UT_BFMIN ;shou!d we send X ON character? 
bhi out_nxon ;no 

-Send XON, space available 

;;out nxon: 



endint: rri 



; return later 



called by rxint for Xon, and 0UT_QC : > A must be preserved 
txonx: Idx #«EG ;for out_qc 

txon: bsat _SCCR2.x.$80 ;set Tx Im En if not already up 



ns 

notran: ;§> bclr?? 

Idaa SCCR2 
anda f$7f 
staa SCCR2 



.entered by nam XOFF 
;get current flags 
.Tiisable transmit intarrupts 
:by lowenng enable 
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2571 






2572 


FE33 


10 20 80 


2573 






2574 






2575 


FE36 


38 


2578 






2577 






2578 


FE37 


00 OA 20 : 


PE3C 20 AO. 


25/9 






2580 






ICO 1 






2582 












2584 














re j u 




X jo / 


FE3E 


37 


iJOO 


FF3F 


3C 


Z JO 3 








FF40 


06 A4 


2591 














FE42 


CI IF 


2594 


FE44 


22 FA 


2595 






2596 






2597 






2598 


FE46 


DE AO 


2599 


FE48 


A7 00 


2600 






2601 


FE4A 


7C 00 A4 


2602 






2603 


FE40 


OS 


2604 






2605 


FE4E 


8C 00 9F 


2606 


FE51 


23 03 


2607 






2608 


FE53 


CE 00 80 


2609 






2610 


FE56 




2611 


FE56 


OF AO 


2612 






2613 


FE58 


80 02 


2814 






2615 


FE5A 


38 


2616 


FE5B 


33 


2617 


FE5C 


OC 


2618 






2619 


FE50 


39 


2620 







Idx #REG ;po»nter 

-bclr SCCR2.x.$80 .disable tx int's 



XRET: 



;xirq m 
rti 

here for bsr limits 
spemsg: db CR.LF." 



: all done here 



' " + $80 ;blanks for memdmp 



; Queue the charecter in acca - > output butter 
; Returns A unchanged 

;:; change to 8 bit offsets from x to improve speed/size since only 256 RAM 
;;: use B more I 
.Preserves B & X 1 A 



OUT QC: 



pshb 
pshx 



rSeve bytes elsewhere 
;sinco we're doing this e lot 



wt_out: idao Out^bffil ;get currant size 

;@@<9> should probably be a ram location 

cmpb #OUT_BFMAX ; check for room 

bhi wt_out : we'll have to wait for room 

or load ec with max and loop on compare bffil for Tighter loop 

::perhaps set carry and return instead of looping 

Idx Out_hdptr :got head pointer 
staa O.X .and store char in que 

inc Outjsffil ;ona more in queue lint's can't affect inca 

inx .step pointer ahead 

cpx IQUT^BFEND ;past end7 

bis outjiorapl ;no. no wrap needed 

Idx #OUT_BFSTA ;yes. wrap back to the start of buffer 



out_norap1: 



pulb 



.page 



stx Out^hdpv .update hdptr 

bsr txonx .start up ints now that X can be mangled 

pulx ;get it all back 

cic ;prevent errors 

rts ;of 0UT_QC 
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2621 






• i 


2622 






*FREMO0: bclr Flag2.MFLG ; clear mode locked flag 


2823 






Idx #?frrmg :and inform 


2624 






bra maod • .-common and 


2625 








2626 






;?frmsg: db *reVe' + *80 


2627 






;lcmsg: db 'ockoVd" ♦ $80 


2628 








2629 






. • • • • i 


2630 






;L0CMO0: bsat Reg2,MFLG ;sa( mode locked flag 


2631 






Idx ftcmsg 


2632 






;mand: :fall into PMSG 


2633 






bra PMSG 


2634 






some of the commands called from RTTBL 


2635 






; Esc exit. CMDOISP jump* to here if ESC entered 


2636 


FE5E 




ESCEXIT; 


2637 






pulx .'pop RTOSPH return (2 not used if BRA cmdsph) 


2638 


FE5E 


38 


polx ?pop caller return (Tune, Dump, etc) 


2639 








2640 


FE5F 


39 


rtend: rts ; should land us in main 


2641 








2642 








2643 






;puts up new line prompt 


2644 


FE60 




(prompt: 


2645 


FE60 


80 40 


bsr CRLF ;Now lino on screen 


2646 








2647 


FE62 


96 18 


Idea Curmod ;got currant mode 


2648 


FE64 


60 59 


bsr QUTRH ,ngnt nana nyooie out 


2649 








2650 


FE66 


96 19 


Idea Currul ^current new rule 


26S1 


FE68 


80 45 


osr HOUtb .pnnt ruia 


2652 








2653 


FE6A 


15 41 08 


K/»l» P\mr> "j f*Cl fl tIaat nirmnt ml<t ntiAda orint Ami 


2654 






LUAA #rn sJfVir i ,rrompi cnarscxer 


2655 


FE60 


86 2A 


2656 


FE6F 


20 CO 


Kr> Ot IT flf* '^tuff in mi it & pftftjrn 

(3ffl wVJ 1 VU^* i J lu 1 1 111 I^UV O lylUUl 


2657 








2658 






and Iprompt 


2659 








2660 






• ••• 


2661 






;PMSG. print string @ X, null or hi-bit tenmnaied 


2662 






. ;BSRs QUT_uC 


2663 








2664 


FE71 




rMovi. 


2665 






tpa .Tjat CC 


2666 






pens ; save, others may need C bit info 


ittO / 








2668 


FE71 


A6 00 


Idea 0,x ;get char 


2669 


FE73 


27 09 


beq ?pmd ;zero is and 


2670 








2671 


FE75 


84 7F 


anda #*7F ; clear high bit to get rid of funny IBM 


2672 


FE77 


80 CS 


bsr 0UT_QC ;phnt it (PMSG) 


2673 








2674 


FE79 


60 00 


tat 0.x .chock for and. MSB high 


2675 


FE7B 


08 


true ; point to next byte 


2676 


FE7C 


2A F3 


bp! PMSG ;more if MS8-0 


2677 


FE7E 




7pmd: 



0S4e655A2_L> 
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2678 
2679 
2680 
2681 
2682 
2683 
2684 
2685 
2636 
2687 
2688 
2689 
2690 
2691 
2692 
2693 
2694 
2695 
2696 
2697 
2698 
2599 
2700 
2701 
2702 
2703 
2704 
2705 
2706 
2707 
2708 
2709 
2710 
2711 
2712 
2713 
2714 
2715 
2716 
2717 
2718 
2719 
2720 
2721 
2722 
2723 
2724 
2725 
2726 
2727 
2728 
2729 
2730 
2731 
2732 
2733 
2734 



etc 
pula 



;stop possible errors (tst cleared C) 



restore CC's 
;@CC save/restore currently bombs. WHY? 



FE7E 39 



rts 



;aJI done 



; • • • • CR then CNTRO 

;CRCNTR: bsr CRLF ;newline 

; • • • • counts up 9 of values in B. printing as it goee 



FE7F 

FE7F 37 
FE80 



;CNTRO: 
CNTR: 


clra 

pshx 
pshb 


; start @ zero 

isave 
;this too 


cntri: 


psha 

bsr HOUTS 


:save 
;print it 




decb 
bitb #7 
bne ?nspc2 


;count down 
;modulo 7 
;no space yat 




bsr OUTS 


;cntr spc out 


;?nspc2: pula 
; inca 


•recover 
;next value 




tstb 


;flags 



FE80 8D OF 

FE82 26 FC 

FE84 33 

FE85 39 



bne cntri ;not yat 
; 5 bytes saved, (looked like 10 but bsr/rts/pshx/pulx ate 5) 

bsr phbc :subr to print, countb etc. saves a & incs 



pulb 
pulx 
rts 



bna cntri ;B not zero, mora to do 

;recover 
:;too 



• • • • 

PHMSG. print hex string @ X. space separated. B has length 
BSRs HOUTS 
Saves B 



FE86 80 1 A 

FE88 37 

FE89 A6 00 

FE88 80 04 

FE80 26 FA 

FE8F 33 

FE90 39 



FE91 36 



PHMSGC: bsr CRLF 

PHMSG: pshb .save it 

?phmsg: Waa 0,x ;get velue 

bsr phbc ;ca(l print subr 



;naw line 



bna 7phmsg 



;not dona yat 



pulb 
rts 



^recover 
: return 



.•••subr for CNTR & PHMSG 

phbc: psha .save for other caller (cntr) 
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2735 


FE92 


80 IB 


her UOllTS *h#y nut uuirh «nara fPMMl 
usr nuu i o .na* out wiin spoco \rnivij 


•57 ifi 
*; / Jo 








Z / 4 / 


CEO j* 


Utf 


inw -neift lid (or wnst nd cvclfts if entrl 


X / JO 


FE95 


C A 


UI^U ,I>VWIH UUnll 








hirh #17 'modulo 7 


X/ *U 




C5 03 


bitb #53 .modulo 4 


2741 






kna )nntne *nn nHHifinn tngrt otitnur 


*n At 
27*2 








2743 


FE9A 


80 15 


oar uu i » . 9oa an axira ona 


274-4 








2745 


FE9C 


32 


n.,U ^a^nuAf rH ji nfK«f a aIIa r l<*nrr\ na«/|« rhi« 

f nospc. puio ,r»covor. ina oinor canor icnirj nooQS uiis 


2746 


FE9D 


4C 


incs ;count up. 


2747 








2748 


FE9E 


50 


tstb ;s6t nao.i 


2749 


FE9F 


39 


rts ;return with CCa sat 


2750 








2751 






; wMur s anas out cr a it 


2752 






; Loaves A a» LF 


2753 






.•>••• CPU £R 0n Jy 


2754 






; HOUTSC. HuUIS -r* uncr 


2755 


FEAO 


80 00 


HOUT5C; Dsr muuio . »pnnt it Tirst 


2756 






;fall into 


2757 


FEA2 


80 71 


wKLr. DSf LMn ,un, nrsi 


2758 








2759 


FEA4 


86 OA 


Mat* #1 C • 1 C MVf 

ioaa •ur »lt naxr 


2760 


FEA6 


20 96 


~, Krai fit IT Of* 'cfiiff JL r»fiirn fjtiart ii«*H Ku WOIJT nvif«) 
ouio. ora uu i uw r scuii ot roiurn \stao uiou oy nuu i ,. 


278 1 








2762 








2763 






• UfM IT7< Um m IT 9 <?riAr»A f mm X v/*Iiia 
, nuu l «ww. Max UU ■ a apoco irorn a voius 








• A rtttii»M« mm COP V U 1 1 nph An/1 aW 

, m raiurns as an*, a. d uncnanyoa 


27ob 






• ncBc- unuT urt«JT«5 
, Dons, nuu i , nuu 1 9 




CP A A 


an en 


HOUTC2* har CRLF -nawtina 


Z/O/ 






HOUT5S* 
nuu i xa. 


77RO 


CCA A 


■*r* 

JU 


n«hv *^a\/a rtifmnf v/mJija 


77RO 
4/v>9 


CP AS 

two 




mil a *OAf Ktoh orrj«p huta 


7770 
4 / / U 




80 07 


bar HOUT Dnnt it (H02S1 


3771 








2772 


FEAE 


32 


pula »Qot low ordar bytfl 


2773 






bsr H0UTS ,*print it with spaca 


2774 






■fail into 


2775 






. • ■ • • 


2776 






' Hay OUT Saaea Max out with soaca 


2777 






* A rtturntri aa saaea S At X ok 


2778 






; JSRt: OUT QC 


2779 






; BSRs: HOUT 


2780 






• • • • • 


2781 


FEAF 




HOUTS: 


2782 


FEAF 


80 04 


bsr HOUT .print it 


2783 








2784 


FEB1 


86 20 


OUTS: Idaa #SPC ;foltowad by.. 


2785 






; bra 0UT_QC ;which returm 


2786 


FEB3 


20 F1 


bra outa ;which returns 


2787 








2788 






. » • • • 


2789 






: Hex OUT. converts the byte in A to hex and outputs 


2790 






; Calls: 0UT_QC. 


2791 






; Destroys A. B St X ok 
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2792 








• • • • 


save it 


2793 


FEB5 


36 


HOUT: psha. 


2794 


FEB6 


80 03 






her ?nurih *«Arv1 Irttt half 














2796 


FEB8 


32 




pula 


.-recover 


2 /9 / 


rCS9 








bra OUTRH ;send right half and let IT return 


2/98 












A/99 


rcoo 


44 


?outih: Isra 


;get high nybbie first 


iOUU 


FEBC 


44 






Isra 


4QW 1 


FEB0 


44 






Isra 


2802 


ceac 
rcoC 






tsra 




2803 












2804 


FEBF 


84 OF 




OUTRH: 


anda #$Gf ;mask out high nybbie 


2805 




OS JU 






adda #$30 ;conv«rt to numeric 


2806 


FEC3 


81 39 






cmpa #3 39 ;in 0-9 range? 


2807 


FECS 


2F OF 






ble outa ;yes 


2808 










adda #$07 ;bias to A-F 


2809 


PPP7 
rcu / 








2810 


FEC9 


20 OB 






bra outa ;send a* return <hout) 


281 1 








■ • • • 




281 2 












2813 












2814 








MEMDMPJ dumps 256 Memory values at address Qiven 


2815 








Bsr's to HOUT & HOUTS & H0UTC2 & 


2816 








ENTDMP uses Msbb for address. lowX for width. htX for line count. 


2817 












28 1 8 








Uth equ 16 


;!ine length memdmp 


28 1 9 




4F 


AOJDMP: 


cira ;start header at zero always 


2820 


FECC 


2D OA 






bra momin 


«04 ■ 














PPPP 


HO FP 3D 




MEMDMP: jsr HEXJHQ ;get start value ;<§ 


2824 


ppm 








bes mend ;no entry so quit. 


"5 Q *> A 

28 2*1 












40 43 


FED 3 


CE 10 10 






Idx #$ 1 0 1 0 ; 1 6 lines, 1 6 elements 


Zo 












*04 / 




96 45 




ENTDMP: Idea Lsbb ;start header count hi 


2828 


FED8 


97 48 




memin: 


staa Acnt .stuff for later use 


7A94 


FEDA 


OF 46 






>tx Lent ;set line count & length f rpm X 


2830 












2831 


FEDC 


CE FE 37 






Idx #spcmsg ;first part 


2832 


FEDF 


8D 90 






bsr PMSG ;of header (MDMP) 


2833 












2834 


FEE! 


96 48 






Idea Acnt ;get starting count 


2835 


FEE3 


06 47 






Idab Uth f& line length 


2836 


FEES 


8D 98 






bsr CNTR ;the rest of the header 


2837 












2838 


FEE7 


D6 46 






Idab Lent ;# of lines to dump 


2839 


FEE9 


DE44 






Idx Msbb .load fetch pointer 


2840 












2841 


FEEB 


80 BB 




?mJp: 


bsr H0UTC2 ;print CR. X & space 


2842 












2843 


FEED 


37 




pshb 


;;save lino counter 


2844 












2845 


FEEE 


06 47 






Idab Uth ;;this many out 


2846 


FEFO 


80 96 






bsr PHMSG :;of this string 


2847 












2848 


FEF2 


33 




puib 


;; recover line counter 
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2o*»3 


FEF3 


5A 


d«cb ;count loop down 


n oca 


FEF4 


26 F5 


bne ?mlp ;on we go 


493 1 






IOC 9 

2852 


rcro 


39 


mend: rts ;untit dona $ at tinei 


2853 














INC/OcC var addresses 








, a sat by nTQSPH to Ad j «J r 




PPP7 






2857 


FEF7 


6C OO 


inc 0.x ;bump up value 






2U 1 1 


bra svp 


2859 








2860 


FEFB 




DEC VAR: 


2861 


FEFB 


6A 00 


dec 0,x 


2862 


FEFD 


20 00 


bra svp 


2863 








2864 


FEFF 




SETVAR: 


2865 


FEFF 


80 FF 30 


jar HEX^BIQ ;get a value 


2866 


FF02 


25 F2 


bcs mend ;no input, use old value (RTS) 


2867 








2868 


FF04 


06 45 


(dab Lsbb .lower order of value input 


2869 


FF06 


OE 48 


Idx Adjadr ; recover value's address 


28 7<J 


CCAO 


t/ uu 


stab 0,x ; change value 


2871 








29 7Z 






bar CRLF .overwrite old screen data 


28 73 


CCA A 


8U 09 


bar CRR .overwrite old screen data 


28 7«V 








2875 


FrOC 


E5 00 


svp: tdab 0,x .'retrieve new value 


XO / O 




OA 7f» 

00 /V* 


Idea #' { ' .'delimiter 


28/7 








/ If 






; print character in A & value in 8 with trailing space 


AO / 9 


FF10 






2880 


FF10 


an ne 

Oh/ V3 


bar outc ;bsr 0UT_QC ."print the char (pcv) 


29a i 






400X 


rr 1 ^ 


I / 


tbe ;get value 








. bra HOUT5 ;dump out and roturn 


2884 


FF13 




Dsr nuu la ;dump out 


2885 














bra CRn ;cr only ck return 


2887 






'fall into 


2888 








2889 


PF1 5 


86 00 


wnn, Hiaa ;wn onfy 


2890 


FF17 


7P ee )c 


outc. jmp uut_qc ;stuff h return (CRR) 


2891 








2892 






•••• *r»H «# PTHARV JL POD 
, anu of rvnAnv «n Win 


2893 








2894 








2895 






* PRUI S 1 nnnf ■ f 0 rm At iwi rtilno rn erra<n (a\**>«fitailui ■ 

• ■ nwuj ) tjintta luimiinu ruiw iu scrasn \BVflniuanyj using so fust suos 


2896 






; Redundant! 


2897 






;PRULS: ;dbg 


2898 






; Idx f 901 10 ; heed or 1 line. 16 elements 


2899 






jar ENTOMP ;do heedor & data <S» Mabb 


2900 








2901 






Idx Adjadr 


2902 






; bar H0UTC2 


2903 








2904 






Idx Mabb 


2905 






bra H OUTC 2 
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2909 






. • • • • 


2Q in 






* IN OQ DoQueue an input choroctor into A 


291 1 






; IN EDQ. Echoed DeQueue 


291 2 






- Alters A 


£9 1 J 






' Use 9 7 indexed refs? common OUT OQ code? 


2914 






. • • • • 


2915 






;@ use in dqw for those callers looping with BCS to IN_DQ 


291 6 








2917 


FF1 A 


80 05 


IN EDQ: bsr IN OQ ;get a char 


29 1 3 








29 1 3 


rr 1 V* 


25 no 


hr« rite *no innuf to echo so end nessirta C 


2Q2Q 














bsr IN DQW ;weit for a char 


?922 


FF1 E 


7E FE 3E 


jmp OUT QC ;ocho it & return 


2923 








2924 






;;IN OQW: bsr IN_DQ ;cail it 








;; bcs IN OQW ; hang around 










292/ 






rts 


4940 








(949 


PP2 1 




IN OQ: 


49JU 


FF21 


96 A5 


Idea In bffil ;gei size (TST larger) 


2931 


rr2J 


20 U2 


one in coni , i»ovo uoior 


2992 








49JJ 


rr43 


nn 
uu 


sec >NO, sot carry & return A as zero 


499*» 




09 


nie. rts 


29<Jo 








49JO 


PP27 




in conf 


49<l / 


PP27 




pshx ;sevo it now 


2938 


FF28 


0E AS 


idx Injfptr ; get pointer 


2939 






: Idab 0.x ;get char 


2940 


FF2A 


A6 00 


Idaa 0,x ;get char 


2941 


FF2C 






2942 


FF2C 


08 


inx ;skip to next spot 


2943 


FF2D 


8C 00 BF 


cpx #IN_BFEND :did we fail off end of buffer? 


2944 


FF30 


23 03 


bis ?m_nowrp2 ;no. skip wrap 


2945 








2946 


FF32 


CE 00 AA 


Idx #IN_BUFSTA ;yas r point back to the start 


2947 


FF35 




7in_nowrp2: 


2949 


FF35 


OF A8 


stx In dptr .updeto tail pointer 


2949 


FF37 


7A 00 A5 


dec ln_bffil ;one lees occupied. Int's can't split this instruction 


2950 








2951 






;; should Idaa bfmtn and compare directly? 


2952 






Idaa ln_bffU 


2953 






cmpa #IN_BFMIN ;should we send XON character? 


2954 






bp! injwon :no 


2955 








2956 






Yes, sand XON. space available 


2957 






;<£>@@ trae needs development. How do you jam into output stream? Use Rags? 


2958 






;in_nxon; 


2959 






tba :copy to a 


2960 


FF3A 


OC 


clc ;no error flag 


2961 


FF3B 


38 


pulx rracover reg 


2962 


FF3C 


39 


rts ;we're done 


2963 








2964 
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HEXJJIN. Convert Ascii hex value 


2966 






DEC "SIN. Convert the characters in buffer to decimal and save in msbbrtsbb 


2967 






Stops at non-numeric char which gets returned in upper case. 


2963 






Carry sat if no data to do 


2969 






Manolas A.B. X 


2970 








2971 






Should NOT convert char to upper case?? 


2972 


PF30 


86 3F 


HEXJ5IQ:ldaa #'?' .-prompt... 


2973 


FF3F 


80 FE 3E 


jsr 0UT_QC ;for input (hexbiq) 


2974 








2975 


FF42 


HEX BIN: 


2976 






bset Bagl.HFLG ;set hex bit 


miw t 1 






bra 7c4dd ;skip past decimal 


2979 








947Q 
£9 / Jf 




;0EC_BIN: 








bclr Rag 1 .HFLG ;clr hex bit 


9991 














<g>@@ mey want a form that skips clear? 




FF42 


4F ?cidd: clra ;clear value 




FF43 


5F 


cirb ;the smaller way 


2985 


FF44 


00 44 


std Msbb ;here, gets Lsbb too 


2986 






bclr Flag 1, NFLG .start out posibva 


2987 






bsr rgchk ■ ;get char & range check 


9999 


FF46 


80 18 


2989 






bcs cend ::out of bounds, return error, no input 


2990 


FF48 


25 34 


2991 








2992 


FF4A 


20 04 


bra ?a2 ;;ok. lets go with 1 st time in 


2993 






bcc ?a2 ;a valid 1st char 


2994 






cmpa negative sign? 


2995 






baq ?sneg ;set negative 


2996 








2997 






cmpa ;plus 


2998 






bna cend .-invalid 1 st char 


2999 






bclr Rag 1 .NFLG ;clr negative flag 


3000 






bra ?a1 


3001 






;?sneg: bset Rag 1, NFLG :set negative flag 


3002 






;fail into additional chars loop 


3003 


FF4C 


80 12 


7a 1: bsr rgchk ;get char & check limits 


3004 








3005 


FF4E 


25 24 


bcs aend ;not valid, we're dona 


3006 






bcaanend ;not valid, we're dona 


30O7 


FF50 






300S 


FF50 


80 30 


?m2i suba #*0* ;0K so far. strip down ascii 


3009 


FF52 


16 


tab ;place in low half 


3010 


FF53 


8F 


xgdx ;;swep to x 


3011 








3012 


FF54 


DC 44 


(dd Msbb :get old value 


3013 


FF56 


05 


aaW ; # 2 


3014 


FF57 


05 


aeld ; *2»4 


3015 






; brdrRagl.HFUG.daec ;hex wey? 


3016 








3017 


FF58 


OS 


aeld ;vos. *2-8 


3018 






bra ?dhex ;do hex 


3019 








3020 






:?ddec: adddMsbb : 4.1-5 


3021 






;?dhax: 



50 



55 
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10 



15 



20 



25 



30 



35 



40 



45 



3022 
3023 
3024 
3025 
3026 
3027 
3028 
3029 
3030 
3031 
3032 
3033 
3034 
3035 
3036 
3037 
3038 
3039 
3040 
3041 
3042 
3043 
3044 
3045 
3046 
3047 
3045 
3049 
3050 
3051 
3052 
3053 
3054 
3055 
3056 
3057 
3058 
3059 
3060 
3061 
3062 
3063 
3064 
3065 
3066 
3067 
3068 
3069 
3070 
3071 
3072 
3073 
3074 
3075 
3076 
3077 
3078 



FF59 OS 



FF5A 8F 

FF5B 3 A 

FF5C DF 44 

FF5E 20 EC 



FF60 80 B8 

FF62 25 FC 

FF64 81 60 

FF66 20 02 

FF68 80 20 
FF6A 



FF6A 81 41 

FF6C 2D 08 

FF6E 81 46 

FF70 2E OC 

FF72 80 07 



FF74 OC 
FF75 39 



asid 
xgdx 



; *2»X!0 or X18 

;;swap back 
abx ;:add in digit 

so Mabb :;store it 

bra 7a1 ;!oop for mora 



•Range chack subr. Gat character and chack for numeric (or hex) 
rgchk: bar INJOQ ;get char with echo 

bcs rgchk .nona avail, wait 

cmpa #*" ;lower case? 

bit ?rgck ;no, leas than 1st LX. char 



?rgck: 



sub a #5 20 



brclr Ragl.HFLG.dchk 



;chongo to upper caeo 
;Hex accepted? Bra if not 



FF76 81 30 

FF78 20 04 

FF7A 81 39 

FF7C 2FF6 

FF7E 00 

FF7F 39 



FF80 

FF80 BO FE 60 

FFB3 C8 07 

FF85 BDFB92 



cmpa #'A' ;in ranga? 

bit dchk ;ioo small, may be 0-9 

cmpa #'F' 

bgt cend ;too big to be used 



suba #7 
bra aend ;ok exit 

clc 
rta 



;shift it to 10-15 



:return no error code k next char in upper case 
;we'ra done. Return to caller 



anend: brclr Rag 1.NFLG. aend ;not negative, do normal exit 

Idd Msbb a«t result 

coma 
comb 

addd 1 1 ;two's complimant negation 

bra aend ;d«an exit 

dchk: cmpa #'0' ;in range? 

bit cend ;too small 

cmpa f'9' 
bgt cand ;too big, set carry 
ble aend ;ok ending 



; return error coda e\ next char in UC 
; DUMP | print the state. CH 0-7 & Digin 



cend: sec 
hand; rta 

; • • • • end of hex bin eto 



DUMP: 



?dvs: 



jsr (prompt :f rash line & prompt with Currut & ' 

Idab #7 ; starting here 

jsr DERIVE jcompute the derivative data 
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3079 


FF88 


5A 




dacb .count down 


3080 


FF89 


2C FA 




bge ?dvs ;until done all 


3081 










3082 


FF88 


r*c tt/\ 
Cc OO 60 




Idx #Anldat ;Data ttored here every 0C1 int 


3083 


FP8E 


C6 10 




Idab #16 :length of string 


3084 




on ce bq 




jar PHMSG ;print in hex (dump) 


3085 










3088 


rrSJ 


BO >W U«J 




Idea PORTC .current digital value* 


3087 


ecu a 


on ^ a 
aU 3A 




bar outb ;jsr HOUTS ;out + ape (dump) 


3088 










3089 






.using RTC for delay 


3090 


FF98 


C6 04 




so bo fgUHA i c tQec race vaiue 


3091 


FF9 A 


CC 1 0 00 




Idx #REG ;gat the base 


3092 


FF90 


ID 25 BF 




?wtrtc: bclr JTL02,x,*BF ;R/M/W knock down RT1F ($40) 


3093 


FFAO 




?ck!p: 




3094 


FFAO 


BO FF 21 




jsr IN_0Q ;any keys? (dump) 


3095 










3096 


FFA3 


24 09 




bec ?srt ;ye*. do em 


3097 










3098 


FFA5 


1 F 25 40 F7 




brclr JTFLG 2.x. $40.7 cklp ;hang around until RTIF 


3099 










3100 


FFA9 


5A 




dacb ; count out time 


3101 


FFAA 


2E F1 




bgt ? wtrtc ;hang around soma mora 


3102 










3103 


FFAC 


ZO DZ 




bra DUMP .another time around 












3105 






;?srt: 


jsr RTDSPH ;check for escape or tuna 


i 1 mi 


rr^c 


51 1 1 R 
9 1 ID 




?sn: cmpa #ESC .escape 


3 lO/ 


ccnn 


AO V*C 




bne OUMP 














CCD -7 




dend: 


rts 


3110 










1111 










1119 






;FLAGS | toggiee various flag bits 


3113 


FFB3 


80 88 




FLAGS: bsr HEXJWQ ;gac bit # 


11 1 A 


rrOs 






bes dend ;no value, skip out 


13 










31 16 


FFB7 


CE 00 40 




Idx #Rag1 .-start hare 


3117 








Idab Lsbb ;get value 


3118 








empb #16 rupper limit 


3119 








bhi dend ;too big (tWe covers negative too since unsigned) 


3120 








bmi dend .-negative, so skip 


31 21 










31 22 






» 


empb #8 .threshold for Reg2 


3123 








bit 7flg1 ( *use ea is 


3124 










31 25 






■ 


inx ;point to Rag2 


3126 






* 


empb #16 .threshold for Rag3 


3127 








blt?flg1 ;ok 


3128 










3129 








inx ;point to Rag3 


3130 






;?flgl: 




3131 






;t8 A vi12v 


3132 


FF8A 


96 45 




Idas Lsbb ;get value 


3133 


FFBC 


16 




tab ;copy 


3134 


FFBO 


56 




rorb ;got highest 5 bits in position 


3135 


FFBC 


56 




rorto 
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10 



15 



20 
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3136 
3137 
3138 
3139 
3140 
3141 
3142 
3143 
3144 
3145 
3146 
3147 
3143 
3149 
3150 
3151 
3152 
3153 
3154 
3155 
3156 
3157 
3158 
3159 



FFBF 56 

FFCO CI 04 

FFC2 22 EE 

FFC4 3A 

FFC5 16 

FFC6 C4 07 

FFC8 4F 

FFC9 00 

FFCA 49 

FFC8 5A 

FFCC 2C FC 

FFCE AS 00 

FFDO A7 00 

FF02 7E FE AF 



forb 



tab 
clra 

?aip: 



outb: 



cmpb *4 ;upper limit with 4 Hogs 

bhi dond .too big so skip out 



abx 



;indox into Rags tablo 



.copy again 

andb 9%t ;mwk to rsmeindar modulo 8 

.start em cry 
sec ;m«ko a high bit 

role ;shift across 

docb ;eount it 

bga ?alp .until -1 (basa 0) 

aora 0,x ;flip tha bits into a 
stao O.x ;and put back 

Imp HOUTS ;acho rasult & return (Iprompt) 



• • • • • 

TEST1 j taats whatavaf 

TEST1: 



3160 


inc SPOR 


;bump up spi data 


3161 


Idy #100 


;prsload this vaiua 


3162 


jar wtlO ;wait a bit 


3163 






3164 


Idx Flagl 


;getem both (DATA! 


3165 


jar H0UTC2 


jdumpam 


3166 






3167 


Idx #SPCR 


;SP1 


3168 


Idab 13 


;tangtrt. pnnts ail thraa SPI raga 


3169 


jmp PHMSG 


;massaga 


3170 FF05 






3171 


Idas Arddat 


;gat chO vafua 


3172 


imp LD_MOTOR 


;uaa it hara 


3173 






3174 


jsr HEX^BIQ 


:gat a value 


3175 


Idas Msbb 




3176 


bar HOUTS 


.upper 


3177 


Idaa Lebb 




3178 


imp HOUT 


;print it and return 



3179 



40 



45 



3180 
3181 
3182 
3183 
3184 
3185 
3186 
3187 
3188 



HELP{ print out screen of help info 



HELP: Idx fHLPMSG 
jmp PMSG 



>Gat pointer 

;Prim halp string & ratum 



; HUP MSG: db CR.LF 

db *? Adj Omp Entr Mdmp Tun Sav 'Rat ~Tat - , CR.LF + $80 
.page 
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70 



75 



20 



25 



30 



3189 

3190 

3191 

3192 

3193 

3194 

3195 

3196 

3197 

3198 

3199 

3200 

3201 

3202 

3203 

3204 

3205 

3206 

3207 

3208 

3209 

3210 

3211 

3212 

3213 

3214 

321 S 

3216 

3217 

3218 

3219 

3220 

3221 

3222 

3223 



FFD5 



FFD6 
FF06 
FF08 
FFOA 
FFOC 
FFDE 



FFEO 
FFE2 
FFE4 
FFE6 
FFE8 
FFEA 
FFEC 
FFEE. 



;lnt«rrupt Vectors 

ABSOLUTE 
org $FFD2 
;RSTT; imp START 



;absoluta position* 

; reserved but we'll use the spece 

;unknow inu trap to here and cause restart 



F0C8 
FBCS 
FBC3 
FBCS 
FBCS 



FBC5 
FSC5 
FBCS 
FBC5 
F947 
FBCS 
FBCS 
FBCS 



org $FF06 

dw SCIINT 
dw START 
dw START 
dw START 
dw START 



org $FFE0 



dw START 
dw START 
dw START 
dw START 
dw T1MINT 
dw START 
dw START 
dw START 



FFDS SC! int 
FF08 SP1 int 
FFOA PA1 
FFDC PAOV 
FFDE TOI 



FFEO OCS int 
FFE2 OC4 
FFE4 0C3 
FFE6 0C2 
FFE8 0C1 
FFEA IC3 
FFEC IC2 
FFEE IC1 









org *FFF0 




FFFO 


FBCS 




dw START 


;FFF0 Real Time Int 


FFF2 


FBCS 




dw START 


;FFF2 Interrupt RaQueet 


FFF4 


FE36 




dw XRET 


;FFF4 XIRQ quick RTI 


FFF6 


FBD6 




dw ISTART 


;FFF« Software Int 


FFF8 


FBD6 




dw ISTART 


;FFF8 Illegal INStruction 


FFFA 


FBCS 




dw START 


;FFFA Computer Opereting Property watchdog 


FFFC 


FBC5 




dw START 


;FFFC CLocK Monitor 


FFFE 


FBCS 




dw START 


;FFFE power on RESET 


0000 






END :o* real code 



Unaa Assembled : 3223 Assembly Errors.: 0 

35 

Claims 

1. In an above knee prosthesis (AKP) having upper and lower leg segments and a connecting knee joint. 
40 the improvement comprising: 

a linear, hydraulic damper for separately and variably damping each of flexion and extension 
rotational movements of the knee joint; 

electronic sensing means for measuring each of AKP knee angle and lower leg segment strain and 
emitting signals indicative thereof; 
46 actuating means for adjusting the damper to vary damping of the knee joint in flexion and 

extension; and 

programmed computer means for receiving the emitted signals from the sensing means and 
comparing them to stored threshold values which are indicative of pre-determined transition points 
selected for adjustment of at least one of flexion and extension damping, and, when the received signal 
so values correlate with stored values, causing the actuating means to vary damping. 

2. A method for controlling the knee joint of an above knee prosthesis having a knee joint, lower leg and 
ankle, comprising: 

storing, in a computer memory, threshold values of lower leg strain and knee angle, which values 
55 are indicative of the knee joint bending in stance phase, of anterior positioning of the center of gravity 
of body weight relative to the ankle, and of swing phase, all in the course of a step along a level 
surface; 

continuously sensing lower leg strain and knee angle during use of the prosthesis and producing 
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electronic signals corresponding thereto; 

comparing the signals against the stored threshold values and, when the signals substantially 
correlate with threshold values, automatically altering the rate of rotation of the knee joint in one or both 
of flexion and extension, as required. 

5 

3. A birdirectional variable linear hydraulic damper for use in an above knee prosthesis, comprising: 

a hollow closed cylinder comprising end walls and a side wall forming a chamber for retaining 
hydraulic fluid, each end wall forming a rod opening; 

a cylindrical hollow piston disposed in the cylinder chamber and adapted to slide longitudinally 
10 therein, said piston having axial rods extending through the rod openings in sealed engagement with 
the cylinder; 

said piston carrying an exterior circumferential seal ring between its ends, said seal ring being in 
sealing relationship with the cylinder side wall, said piston being formed by end walls and a side wall, 
said piston forming a first aperture through its wall above the seal ring and a second aperture through 
75 its wall below the seal ring; 

a first one way check valve controlling the first aperture for enabling ingress of fluid into the piston 
chamber from the first end of the cylinder chamber; 

a second one way check valve controlling the second aperture for enabling ingress of fluid into the 
piston chamber from the second end of the cylinder chamber; 
20 a first pair of diametrically opposed ports extending through the piston side wall adjacent its first 

end, on one side of the seal ring; 

a second pair of diametrically opposed ports extending through the piston side wall adjacent its 
second end, on the other side of the seal ring; and 

valve means for progressively reducing or increasing the effective area available for fluid flow of the 
25 first ports and separately progressively reducing or increasing the effective area available for fluid flow 
of the second ports. 

4. In an above knee prosthesis (AKP) for use by a human user, said AKP having upper and lower leg 
segments, a knee joint connecting the segments, and a foot attached to the base of the lower leg 

30 segment, the improvement comprising: 

means, pivotally connected with the leg segments, for separately and variably damping each of 
flexion and extension rotational movements of the knee joint; 

electronic sensing means for monitoring AKP knee angle and position of the center of gravity of the 
user's body relative to the AKP foot and emitting signals indicative thereof; 
35 actuating means for adjusting the damping means to vary damping of the knee joint; and 

programmed computer means for receiving the emitted signals from the sensing means and 
continuously establishing from said signals the state of the AKP in the course of a movement and 
activating the actuating means to vary damping to substantially simulate natural knee action. 

40 5. The improvement as set forth in claim 4 wherein the damping means comprises: 
a pair of closed chambers for containing hydraulic fluid, 

means, connected to the leg segments and forming two passageways connecting the chambers, 
for moving fluid from one chamber to the other through one of the passageways when the leg 
segments are moving together and through the other of the passageways when the leg segments are 
45 moving apart, and 

means for regulating the flow of fluid through each passageway; 

said actuating means being adapted to adjust the regulating means to vary damping of the knee 
joint. 

50 6. The improvement as set forth in claim 4 wherein the damping means is a bi-directional variable linear 
hydraulic damper comprising: 

a hollow closed cylinder comprising end walls and a side wall forming a chamber for retaining 
hydraulic fluid; 

a cylindrical hollow piston disposed in the cylinder chamber and adapted to slide longitudinally 
55 therein; 

said piston carrying an exterior circumferential seal ring between its ends, said seal ring being in 
sealing relationship with the cylinder side wall, said piston being formed by end walls and a side wall, 
said piston forming a first aperture through its wall above the seal ring and a second aperture through 
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its wall below the seal ring, said piston dividing the cylinder chamber Into closed first and second 
end chambers; 

a first one way check valve controlling the first aperture for enabling ingress of fluid into the piston 
chamber from the first end chamber; 

a second one way check valve controlling the second aperture for enabling ingress of fluid into the 
piston chamber from the second end chamber; 

a first pair of diametrically opposed ports extending through the piston side wall adjacent its first 
end, on one side of the seal ring; 

a second pair of diametrically opposed ports extending through the piston side wall adjacent its 
second end, on the other side of the seal ring; and 

valve means for progressively reducing or increasing the effective area available for fluid flow of the 
first ports and separately progressively reducing or increasing the effective area available for fluid flow 
of the second ports; 

said actuating means being adapted to adjust the valve means to vary damping of the knee joint. 

7. The improvement as set forth in claim 4 wherein the programmed computer means is adapted to 
compare the emitted signals against stored threshold values indicative of transition points between 
states of a repetitive movement of the AKP and. when the signals substantially correlate with threshold 
values, to alter the rate of rotation of the knee joint in one of or both of flexion and extension. 

a. The improvement as set forth in claim 7 wherein the stored threshold values are selected from the- 
group consisting of the absolute and derivative values of knee angle and the position of the center of 
gravity of the user's body relative to the AKP foot, the duration from the last transition point and the 
possible future states in the course of the movement. 

9- The improvement as set forth in claim 8 wherein: 

the sensing means for monitoring the position of the center of gravity of the user's body relative to 
the AKP foot consists of means for monitoring lower leg strain. 

10. The improvement as set forth in claim 6 wherein the programmed computer means is adapted to 
compare the emitted signals against stored threshold values indicative of transition points between 
states of a repetitive movement of the AKP and, when the signals substantially correlate with threshold 
values, to alter the rate of rotation of the knee joint in one of or both of flexion and extension. 

11. The improvement as set forth in claim 10 wherein the stored threshold values are selected from the 
group consisting of the absolute and derivative values of knee angle and the position of the center of 
gravity of the user's body relative to the AKP foot, the duration from the last transition point and the 
possible future states in the course of the movement. 

12. The improvement as set forth in claim 11 wherein: 

the sensing means for monitoring the position of the center of gravity of the user's body relative to 
the AKP foot consists of means for monitoring lower leg strain. 
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Fig. 29. 
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Fig. 33. 



The core of tne program is the Timer Interruot Service Routine. 
Every 20 miliseconas the timer interrupts and... 



Timer Interrupt fT melnt @ 20 milisecond intervals) 
Get new A/D values into FIFO (first in, first out), discarding oldest values. 
Generate any required output to actuators. 
IF stop timer running, count down. On time-out, set halt flag, force 

battery cut-off rule to fire. 
IF Seep command active, execute time-outs as required, turn Beeper on/off. 
IF forced rule active, count down time. On time-out. force rule. 

goto £ND_OF_SCAN. 
IF not halted or not scanning already, scan rule table for executable rules. 
END OF SCAN: Return from timer interrupt 



Scan: {of rules) 

For each active rule in MODE bit field 

IF rule preconditions exist and are met 

AND If digital conditions exist and are met 

AND If analog conditions exist and are met 

THEN fire rule, exit loop, (only one rule fires per timer interrupt). 



FireRule: 

IF rule number not inhibited THEN generate required output 
(Digital, Analog, Pulse, Mode change. Subroutine, Beep etc) 
Output current rule number to SPI port to permit external 
D/A monitoring of state changes. 
If a Forced Time exists, update FRCT1M counter. 
If rule is not speciaJ case (#0), update current rule value in memory, 
(for rule precondition tests). 



A standard Implementation of circular buffers is used for interrupt driven 
Input and output via a serial communications port on the microprocessor. 
On each serial communications interrupt.. 



SERIAL INTERRUPT: 

IF Receiver Interrupt THEN 

WHILE we do not have space in tine input circular buffer. WAIT. 
Enque me received character, update in ^pointer & counter. 
ELSEIF 

Transmitter interrupt THEN 

IF we have a character to send, send it update out jxrinter & counter. 
ELSE 

turn off transmitter interrupt since nothing left to send. 
Return from SERIAL INTERRUPT 
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! Entry on oower up I 

L_ 

INITIALIZATION: 
initiaJiza memory, data tables & registers to support interrupt 
driven input & output and timer interrupts. 
Make default set of rules active. 
Force rule #1 to fire, (start-up rule) 

r~ 

MAIN: 

IF current state value changes, display changed value. 
Await communication line input 
_ IF a valid command character has been entered, 
execute chosen command. 
ELSE 

display error message. 
Goto MAIN 



Fig. 34. 



ADJUST: 

Prompt for rule # to adjust. Accept input from communication line. 
Display chosen rule # elements. Prompt for element # to adjust 
Make adjustments as commanded by communication line input 
Return to MAIN 

DUMP: 

Until terminated by communication line command input... 
DISPLAY: 

Display current Mode. State #, A/D values & Derivatives 
and Digital input value. 

Wait for preset time (nominally 10 lines per second). . 

Goto DISPLAY , 

ENTER: 

Prompt for address to modify. Accept input from communication line. 
Display current value at specified address. 

Make changes to value as commanded by communication line input 
Return to MAIN when changes completed. 

MEMORY: 

Prompt for address to display. Accept input from communication fine. 
Display 256 values from that address forward. 
Return to MAIN 

Save: 

Save any changes made to last selected rule # to EEPROM. 
Return to MAIN 
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© This invention relates to an above knee prothesis 
which employs a hydraulic damper to passively reg- 
ulate the angular velocity or rotation of the artificial 
knee joint. A programmed microprocessor recog- 
nizes common gait patterns from information re- 
ceived from strain and knee angle sensors on the 
prosthesis. The microprocessor reacts at various, 
transition points in the gait by activating a motor 
which in turn adjusts a valve assembly in the damp- 
er. The valve assembly is capable of variably and 
separately damping the knee joint motion in each of 
flexion and extension at the same time. Gait is 
improved because of the improved extent of control 
of knee action. In addition, distinct routines such as 
stair descending and sitting down can also be prac- 
tised. 
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